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Chapter  1 


Introduction 


Systems  on  matrix  Lie  groups,  the  main  topic  of  this  thesis,  are  an  interesting 
subject  of  study  both  from  a  practical  as  well  as  from  a  control-theoretic  point 
of  view.  Due  to  their  unique  combination  of  geometric  and  algebraic  properties, 
Lie  groups  arise  naturally  as  the  models  for  the  configuration  space  of  mechan¬ 
ical  systems  which  provide  the  major  practical  motivation  for  their  study.  For 
instance  the  position  and  orientation  of  a  rigid  body  in  Euclidean  space  can  be 
completely  characterized  by  the  Special  Euclidean  Group  SE( 3)  or,  more  specifi¬ 
cally  by  the  matrix  representation  of  the  abstract  Lie  group  SE( 3).  Formulating 
the  kinematics  of  such  a  mechanical  system  having  a  matrix  Lie  group  G  as  a 
configuration  space  then  leads  to  a  matrix  valued  differential  equation  defined 
on  G.  We  call  such  a  differential  equation  a  system  on  a  matrix  Lie  group  to  em¬ 
phasize  our  objective  of  motion  control  and  interpret  the  system’s  configuration 
as  an  output  while,  in  the  case  of  a  mechanical  systems,  viewing  the  velocities  as 
inputs.  System  on  matrix  Lie  groups  thus  End  application  in  modeling  and  mo¬ 
tion  control  of  mechanical  systems  such  robotic  manipulators,  wheeled  robots, 
underwater  vehicles  and  space-craft.  Next  to  mechanical  applications,  Lie  groups 
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also  arise  from  physical  conservation  principles  such  as  conservation  of  energy. 
For  instance  electrical  networks  used  for  power  conversion  can  be  modeled  as 
evolving  on  the  Special  Orthogonal  Group  SO(n )  (Wood,  1974),  and  so-called 
multilevel  systems  used  to  model  molecular  bonds  in  the  context  of  coherent 
control  of  quantum  dynamics  can  naturally  be  represented  as  systems  on  the 
complex  unitary  group  U{n)  (Dahleh  et  al,  1996). 

On  the  other  hand  invariant  systems  on  Lie  groups  are  of  special  interest  in 
the  theoretical  context  of  nonlinear  control  theory  since  they  form  an  important 
sub-class  of  nonlinear  systems.  Their  structure  naturally  leads  to  simplifica¬ 
tions  which  allows  us  to  study  the  essence  of  various  nonlinear  control  questions 
without  the  technicalities  of  more  general  formulations.  For  instance  the  Lie 
algebra  of  vector  fields  of  invariant  systems  on  finite- dimensional  Lie  groups  is 
finite-dimensional  and  the  corresponding  distributions  are  regular.  The  study 
of  problems  like  controllability  can  therefore  be  reduced  to  a  study  of  the  Lie 
algebra  g  of  the  Lie  group  G  underlying  the  given  system.  Thereby  one  can 
make  use  of  the  impressive  geometric  and  algebraic  machinery  developed  for  Lie 
groups  and  Lie  algebras  in  the  course  of  the  last  century. 

The  global  coordinate-free  description  of  dynamical  systems  allows  us  to  ad¬ 
dress  certain  qualitative  questions  with  elegant  geometric  reasoning.  For  example 
the  existence  of  a  smooth,  static  feedback,  globally  asymptotically  stabilizing  the 
origin  of  a  system  on  SO[n )  can  be  precluded  immediately  since  Wilson  (Wil¬ 
son,  1967)  showed  that  the  domain  of  attraction  of  an  asymptotically  stable 
equilibrium  point  is  diffeomorphic  to  Rn,  while  it  is  well  known  that  SO(n )  is 
not.  In  another  instance  the  fact  whether  the  underlying  Lie  group  G  is  com¬ 
pact  or  not,  turns  out  to  be  a  crucial  ingredient  in  establishing  controllability  of 


2 


systems  with  drift.  Such  geometric  insight  is  either  lost  or  concealed  in  a  local 
representation  of  the  given  system,  and  arguments  of  the  kind  mentioned  above 
might  not  be  possible  or  as  obvious  if  the  given  system  is  immediately  expressed 
in  local  coordinates. 

Even  if  we  will  venture  into  local  coordinates  eventually  to  obtain  explicit 
control  laws,  it  is  of  great  importance  which  coordinate  description  we  choose, 
emphasizing  again  the  advantage  of  using  the  global  description  as  a  starting 
point  when  analyzing  a  dynamical  system.  In  this  thesis  for  instance  two  canon¬ 
ical  constructions  of  coordinates  and  their  properties  will  play  a  key  role  in  the 
derivation  of  motion  control  results. 

Systems  on  Lie  groups  were  brought  to  the  attention  of  the  controls  commu¬ 
nity  by  Roger  Brockett  (Brockett,  1972)  in  the  early  70’s  and  further  analyzed  by 
Jurdjevic  and  Sussmann  (Jurdjevic  &  Sussmann,  1972).  These  and  other  early 
studies  were  mainly  concerned  with  existence  questions  and  established  Lie  alge¬ 
braic  criteria  for  problems  such  as  controllability  and  observability.  Constructive 
questions  for  systems  on  Lie  groups  such  as  deriving  optimal  controls  for  cer¬ 
tain  lower-dimensional  system  on  Lie  groups  were  taken  up  in  (Krishnaprasad, 
1993;  Tsakiris,  1995).  In  (Leonard  &  Krishnaprasad,  1995)  algorithms  based  on 
average  theory  are  presented  to  steer  generic,  controllable,  drift-free,  invariant 
systems  on  matrix  Lie  groups  approximately  to  a  desired  point  in  the  configura¬ 
tion  space. 

We  will  focus  in  this  thesis  on  nonholonomic  (or  under-actuated),  drift-free, 
invariant  systems  on  matrix  Lie  groups  and  consider  mainly  the  open-loop  track¬ 
ing  and  feedback  stabilization  problem  for  such  systems. 

Nonholonomic  systems  for  which  the  number  m  of  controls  is  strictly  smaller 
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than  the  dimension  n  of  the  underlying  state  space  arise  in  practice  through 
kinematic  constraints,  like  the  no-slip  condition  for  wheeled  vehicles,  through 
conservation  principles,  such  as  the  conservation  of  angular  momentum  for  a 
floating  bar  linkage  (Yang  &  Krishnaprasad,  1992),  or  simply  through  lack  or 
failure  of  actuators,  such  as  for  a  satellite  with  a  failing  gas  jet.  As  opposed  to 
holonomic  systems  with  m  inputs  the  motion  of  a  m-input  nonholonomic  systems 
is  not  constrained  to  a  m-dimensional  submanifold  of  the  state  space,  but  can 
encompass  the  whole  state  space. 

The  problem  of  tracking  a  generic  trajectory  in  state  space  with  a  nonholo¬ 
nomic  system  which  is  also  labeled  nonholonomic  motion  planning  is  obviously 
not  exactly  solvable  due  to  the  presence  of  the  velocity  constraints.  But  already 
in  (Haynes  &  Hermes,  1970)  it  was  shown  that  there  exist  sequences  of  controls 
for  drift-free,  nonholonomic  systems  such  that  the  resulting  trajectories  uni¬ 
formly  approximate  any  given,  sufficiently  smooth,  generic  trajectory,  although 
no  concrete  constructive  procedure  was  given  there. 

The  principle  underlying  such  approximate  tracking  controls  is  that  peri¬ 
odic  controls  with  specific  phase  relations  between  certain  inputs  cause  secular 
motions  in  the  direction  of  the  higher-order  Lie  brackets  required  for  control¬ 
lability.  This  corresponds  to  the  familiar  parallel  parking  maneuver,  where  a 
side-ways  motion  which  is  constrained  by  the  no-slip  condition  of  the  wheels  can 
be  achieved  secularly  by  switching  between  forwards,  backwards  and  turning 
maneuvers  in  a  suitable  fashion.  A  tight  parking  space  requires  more  of  these 
elementary  maneuvers,  a  fact  which  illustrates  the  need  for  high-frequency  oscil¬ 
latory  controls  if  the  accuracy  of  the  trajectory  approximation  is  to  be  improved. 

The  problem  of  actually  constructing  feasible  paths  between  arbitrary  conhg- 
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urations  was  first  addressed  in  (Laumond,  1987)  in  the  context  of  mobile  wheeled 
robots.  The  realization  that  such  wheeled  vehicles  can  locally  be  transformed 
to  the  class  of  so-called  nilpotent  systems,  so  called  chained  form  systems  in 
particular,  and  that  this  class  has  properties  facilitating  the  solution  of  motion 
control  problems  lead  to  a  line  of  work  documented  in  (Lafferriere  &  Sussmann, 
1991;  Brockett  &  Dai,  1992;  Murray  &  Sastry,  1993).  In  (Sussmann  &  Liu,  1991) 
the  problem  of  approximate  tracking  for  drift- free,  controllable,  input- linear  sys¬ 
tems  is  tackled  in  a  general  setting,  and  highly  oscillatory  controls  are  presented 
such  that  resulting  trajectories  converge  uniformly  to  a  given  generic  smooth 
trajectory. 

In  parallel  to  the  problem  of  steering  of  nonholonomic  systems  the  problem  of 
feedback  stabilization  of  nonholonomic  systems  has  received  considerable  atten¬ 
tion  in  the  last  decade.  In  (Coron,  1992)  the  existence  of  time-varying  stabiliz¬ 
ing  controls  for  drift-free,  controllable,  input-linear  systems  was  shown,  while  in 
(Pomet,  1992)  a  method  to  explicitly  construct  such  control  laws  for  a  restricted 
class  of  systems  was  presented.  To  improve  the  slow  convergence  rates  of  such 
smooth  feedback  laws  (M’Closkey  &  Murray,  1995)  introduced  time- varying, 
non-smooth  control  laws  based  on  the  idea  of  homogeneous  feedback  leading 
to  exponential  convergence  of  trajectories.  Making  use  of  the  constructions  of 
(Sussmann  &  Liu,  1991)  this  idea  was  taken  further  in  (Morin  et  al,  1996) 
where  explicit,  homogeneous  feedback  laws  for  stabilization  of  generic, drift-free, 
homogeneous  systems  are  presented. 

As  opposed  to  (Sussmann  &  Liu,  1991)  where  the  problem  of  approximate 
tracking  of  drift-free  system  is  tackled  with  a  complex  machinery  in  the  most 
generic  setting,  we  will  follow  a  bottom-up  strategy  by  first  deriving  relatively 
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simple  control  laws  for  a  class  of  nilpotent  systems.  Analogous  to  the  technique 
of  feedback  linearization  this  class  of  system  is  interpreted  as  a  canonical  form 
feedback  equivalent  to  a  wider  class  of  systems,  allowing  us  to  extend  the  appli¬ 
cability  of  the  derived  control  laws.  The  technique  of  feedback  nilpotentization 
is  then  applied  specifically  to  local  representations  of  systems  on  matrix  Lie 
groups  to  compute  the  required  transformations,  and  the  specifics  arising  from 
this  set-up  are  studied.  It  is  then  shown  how  these  transformations  can  be  uti¬ 
lized  to  derive  open-loop  approximate  tracking  controls  and  stabilizing  feedbacks 
for  non-nilpotent  systems  on  matrix  Lie  groups. 

Chapter  2  reviews  some  basic  notions  concerning  finite-dimensional  Lie  groups, 
Lie  algebras  and  their  concrete  representations  as  matrix  Lie  groups  and  al¬ 
gebras.  Systems  evolving  on  matrix  Lie  groups  are  defined,  categorized,  and 
characterized  in  terms  of  their  controllability  properties.  The  choice  of  suitable 
coordinates  for  a  given  control  problem  turns  out  to  be  a  crucial  decision  when 
studying  systems  on  Lie  groups.  We  present  local  representations  of  systems 
on  Lie  groups  based  on  two  canonical  constructions  of  coordinates  used  in  the 
course  of  the  thesis  and  study  their  properties.  Finally  we  describe  in  a  series  of 
examples  how  systems  on  matrix  Lie  groups  arise  as  models  of  the  kinematics  of 
concrete  mechanical  systems  and  other  motion  control  problems. 

In  Chapter  3  we  describe  the  basic  motion  control  problems  for  nonholonomic 
systems  and  define  the  notion  of  an  approximate  inverse  system  which  was  in¬ 
troduced  in  (Brockett,  1993).  Using  the  example  of  Brockett’s  nonholonomic 
integrator  it  is  demonstrated  how  oscillatory  control  components  can  be  used  to 
create  secular  motions  in  the  direction  of  higher  order  Lie  brackets  and  how  these 
such  motions  can  be  made  increasingly  independent  of  each  other  by  increasing 
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a  frequency  parameter  in  the  control  laws.  Since  an  approximate  tracking  con¬ 
trol  law  is  defined  only  in  terms  of  a  limit  process,  i.e.  the  resulting  trajectories 
converge  to  a  desired  trajectory  in  the  high-frequency  limit,  solutions  to  this 
problem  are  not  unique.  We  describe  different  ways  to  implement  the  motion 
generation  by  oscillatory  control  components  leading  to  different  requirements 
for  the  actuators  of  the  underlying  system.  The  chapter  concludes  with  a  discus¬ 
sion  of  the  optimality  of  tracking  controls  with  sinusoidal  oscillatory  components 
for  the  nonholonomic  integrator. 

It  has  been  a  common  feature  in  recent  work  on  motion  control  of  nonholo¬ 
nomic  systems  to  tackle  control  problem  first  in  a  nilpotent  setting,  for  instance 
by  restricting  attention  to  systems  in  chained  or  in  power  form,  to  make  use  of 
simplifications  arising  from  the  corresponding  Lie  algebra  structure.  We  follow 
a  similar  approach  and  start  out  in  Chapter  4  by  pointing  out  that  chained  form 
systems,  power  forms  systems,  as  well  as  Brockett’s  nonholonomic  integrator  all 
originate  from  invariant  systems  on  the  same  nilpotent  matrix  Lie  group.  In  the 
main  result  of  this  chapter  approximate  inversion  controls  are  presented  for  the 
single  generator  chained  form  systems  with  two  or  more  inputs.  A  discussion  of 
implementational  issues  related  to  this  control  laws  ends  the  chapter. 

Chapter  5  is  concerned  with  the  problem  of  nilpotentization  of  local  repre¬ 
sentations  of  systems  on  matrix  Lie  groups.  We  show  that  for  the  most  com¬ 
mon  invariant  systems  on  three-dimensional  matrix  Lie  groups  the  nilpotentizing 
transformations  can  be  calculated  in  an  explicit  form  directly  from  the  corre¬ 
sponding  Lie  algebra  structure.  The  so-called  product  of  exponential  coordinates 
plays  a  crucial  role  in  this  process,  and  the  transformations  basically  fall  out  as 
byproducts  of  the  computations  for  the  corresponding  local  representation.  This 
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explains  the  fact  that  nilpotentizing  transformations  derived  in  this  way  share 
their  region  of  validity  with  the  corresponding  local  representation  itself.  After 
reviewing  the  necessary  and  sufficient  conditions  for  nilpotentization  we  explore 
the  possibility  of  transforming  system  on  higher- dimensional  matrix  Lie  group 
into  chained  or  other  nilpotent  forms  in  the  second  part  of  the  chapter. 

In  the  first  section  of  Chapter  6  we  use  the  results  from  Chapter  4  and  Chap¬ 
ter  5  to  construct  approximate  tracking  controls  for  systems  nilpotentizable  to 
chained  form.  The  resulting  control  laws  which  involve  a  feedback  are  then  con¬ 
verted  into  open  loop  forms  using  a  relatively  simple  feed-forward  estimate  of  the 
state  trajectories.  In  the  last  section  of  this  chapter  we  show  how  exponentially 
stabilizing  feedback  laws  can  be  derived  via  nilpotentization  and  a  construction 
of  feedback  laws  for  nilpotent  systems,  which  has  been  presented  by  Morin  and 
co-workers  (Morin  et  al,  1996). 

Numerical  simulations  are  presented  throughout  the  thesis  wherever  they 
enhance  the  understanding  of  the  corresponding  control  laws. 


Chapter  2 


Preliminaries 


This  chapter  introduces  the  mathematical  concepts  and  tools  related  to  differ¬ 
ential  equations  evolving  on  finite-dimensional  Lie  groups  which  will  be  used 
throughout  the  thesis.  After  reviewing  basic  properties  of  Lie  groups  and  Lie 
algebras,  we  define  and  characterize  dynamical  systems  on  Lie  groups.  Further, 
we  introduce  and  compare  local  representations  of  these  systems,  in  which  most 
of  the  actual  computations  will  be  carried  out  later  on.  Hereby  we  follow  the 
basic  references  (Varadarajan,  1974;  Curtis,  1984;  Marsden  &  Ratiu,  1994). 

2.1  Lie  groups  and  Lie  algebras 

Conceived  in  the  last  third  of  the  19th  century  by  Marius  Sophus  Lie  (1842- 
1899)  as  a  tool  for  the  solution  of  differential  equations  the  theory  of  Lie  groups 
and  Lie  algebras  has  since  then  developed  into  a  discipline  in  its  own  right. 
By  their  very  nature  Lie  groups  bring  together  the  mathematical  disciplines  of 
algebra  and  geometry  to  produce  results  which  elegantly  rely  on  the  interaction 
of  differential  geometric  and  group-theoretic  tools. 

In  systems  theory  Lie  groups  often  arise  as  models  for  the  configuration  space 
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of  mechanical  systems.  The  fact  that  such  systems  allow  at  each  point  of  the 
configuration  space  a  continuous  range  of  motions  is  accounted  for  by  choosing 
a  differentiable  manifold  as  the  underlying  set  of  the  configuration  space.  The 
algebraic  character  of  the  modeling  Lie  group,  on  the  other  hand,  reflects  that 
motions  of  such  systems  can  be  composed  to  obtain  new  motions  and  that  any 
motion  can  be  reversed. 

Definition  2.1.1  (Lie  group)  A  Lie  group  G  is  a  differentiable  manifold  which 
is  also  endowed  with  a  group  structure  such  that  the  group  multiplication 

p, :  G  x  G  — »  G\  (g,h)^gh  (2.1) 


is  a  C°°  map. 

I.e.,  given  a  set  of  coordinates  for  the  group  manifold,  the  coordinates  of  the 
product  of  the  two  group  elements  have  to  be  smooth  functions  of  the  coordinates 
of  the  factors.  Using  the  implicit  function  theorem  it  can  be  shown  that  for  a 
Lie  group  as  defined  above  the  inversion  map 

I :  G  G]  g  i-»  g  1 


is  also  a  C°°  function. 

Given  elements  g,  h  G  G  we  define  the  associated  left  translation  Lg  :  G  — >• 
G ;  h  i — y  gh,  and  the  right  translation  Rg  :  G  — »  G;  h  hg ,  respectively.  By 
the  properties  of  Lie  groups  both  these  maps  are  diffeomorphisms.  The  map  Lg 
applied  to  h  e  G  induces  a  linear  map  ThLg  from  the  tangent  space  ThG  of  G  to 
Tgh  which  turns  out  to  be  an  isomorphism.  Similarly,  T/,/h,  is  a  tangent  space 
isomorphism. 
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We  can  now  construct  a  smooth  vector  field  X  on  G  by  picking  a  vector 
£  =  X(e)  in  TeG  and  transplanting  it  with  TeLg  such  that 

X^g)  =  (TeLg)X(e),  Wg  G  G.  (2.2) 

In  general,  a  vector  field  X  satisfying 

e ThLg)X(h )  =  X(gh),  Vg,heG  (2.3) 

is  called  left-invariant.  Similarly,  we  can  define  and  construct  right-invariant 
vector  fields  on  G.  Right-invariant  vector  fields  are  related  to  left-invariant 
vector  fields  X \  by 

hXt  =  -Y;,  (2.4) 

where  /*  denotes  the  tangent  space  map  associated  with  the  inversion  map  I. 
Because  of  this  correspondence  we  can  focus  without  loss  of  generality  on  left- 
invariant  notions,  while  keeping  in  mind  that  most  constructions  can  be  carried 
out  analogously  for  the  corresponding  right-invariant  notions. 

Definition  2.1.2  (Lie  Algebra)  A  Lie  algebra  is  a  real  vector  space  equipped 
with  a  bilinear  operator  [•,  •]  :gxg->g,  called  the  Lie  bracket,  such  that  for  all 
x,y,zeg 

[x,y]  =  —[y,x]  (skew- symmetry) 

[x,  [y,  z]\  +  (y,  [z,  x]]  +  [z,  [x,  y]\  =  0  (Jacobi  identity) 

Let  Yi  and  Y>  denote  left-invariant  vector  fields  on  a  Lie  group  G.  Then, 
aYi  for  a  G  1,  I)  +  Y2,  and  where  [•,•]  denotes  the  Jacobi-Lie  bracket 

for  vector  fields,  are  also  left- invariant  vector  fields  on  G.  Thus,  the  set  Xl(G) 
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of  left- invariant  vector  fields  on  G  forms  a  Lie  algebra,  actually  a  subalgebra  of 
X(G),  the  smooth  vector  fields  on  G. 

As  mentioned  above  the  tangent  space  TeG  at  the  identity  and  XjfG)  are 
related  by  the  transplantation  map 

t :  TeG  ->■  X,  £  ^ 

and  the  evaluation  map 

e  :  XL(G)  TeG,  X  ^  X(e) 

and  turn  out  to  be  isomorphic  as  vector  spaces.  Moreover,  TeG  inherits  the  Lie 
algebra  structure  of  Xl(G)  by  the  induced  bracket 

K,  *7]  =  PQ,V,](e). 
and  is  called  the  Lie  algebra  g  of  G. 

This  bijection  between  TeG  and  Xl(G),  which  can  also  be  extended  to  one- 
parameter  subgroups  (j>  :  R  — *  G]  f  4  (f(t)  of  G  and  left-invariant  R- actions 
$  :  R  x  G  — *  G]  (t,g)  (->•  g<f>(t)  on  G,  is  one  of  the  main  appeals  of  Lie’s  theory. 
Many  properties  of  the  Lie  group  G  are  reflected  in  the  algebraic  structure  of 
the  associated  Lie  algebra  g.  For  connected  Lie  groups  this  correspondence  goes 
as  far  as  that  the  Lie  group  can  be  recovered  up  to  an  isomorphism  from  its 
Lie  algebra.  In  our  context  the  correspondence  allows  us  to  reduce  problems 
involving  invariant  vector  fields  on  a  Lie  group  G  to  problems  in  the  setting  of 
Lie  algebras  g,  thus  reducing  the  inherent  nonlinearity  of  invariant  systems  on 
Lie  groups  to  the  algebraic  structure  on  a  linear  vector  space. 

Given  two  subspaces  gi,  g2  of  a  Lie  algebra  g  denote 

[01,02]  =  {[Z,v\  e  olf  e  0i ,  v  e  02}- 
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A  subspace  of  gi  of  g  is  called  a  subalgebra  if  [gi, gi]  C  gi.  It  is  an  ideal  if 
[0i,0]  C  gi.  The  following  nested  sequences  of  ideals  are  used  to  characterize 
Lie  algebras.  The  derived  series  of  g  is  defined  by 

0Cg'=  [g,  g]  C  g"  =  [g',  g']  C  •  •  •  C  gn  =  [g(n-1},  g(n"1}]  C  •  •  • 

The  lower  central  series  is  defined  by 

0  C  g2  =  [g,g]  C  g3  =  [g2,g]  C  •  •  •  C  gn  =  [gn-\g]  C  ••• 

We  have 

gnCg(n+1),  n  —  2,3, ... .  (2.5) 

The  following  characterizations  are  shared  by  Lie  groups  and  Lie  algebras 
but  can  be  checked  more  easily  in  the  linear  setting  underlying  Lie  algebras. 
Following  the  remarks  above  we  will  define  them  directly  for  Lie  algebras. 

Definition  2.1.3  (Abelian  Lie  Algebra)  A  Lie  algebra  g  is  called  Abelian  if 
0'  =  02  =  0. 

Definition  2.1.4  (Nilpotent  Lie  Algebra)  A  Lie  algebra  g  is  called  nilpotent 
if  the  lower  central  series  terminates  after  a  finite  number  of  steps,  i.e.  gfc  =  0, 
for  some  integer  k. 

Definition  2.1.5  (Solvable  Lie  Algebra)  A  Lie  algebra  g  is  called  solvable 
if  the  derived  series  terminates  after  a  finite  number  of  steps,  i.e  g^  for  some 
integer  k. 

Since  g^  C  gn+1,  n  —  1, 2,  3, ...  a  solvable  Lie  algebra  is  also  nilpotent. 

Definition  2.1.6  (Simple  Lie  algebra)  A  Lie  algebra  g  is  called  simple  if  it 
is  non- Abelian  and  its  only  ideals  are  0  and  G 
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Definition  2.1.7  (Semi-simple  Lie  algebra)  A  Lie  algebra  g  is  called  semi¬ 
simple  if  its  only  Abelian  ideal  is  0. 

A  simple  Lie  algebra  is  also  semi-simple.  For  3-dimensional  Lie  algebras 
0  =  g'  implies  simplicity. 

Next  we  will  study  a  map  relating  a  Lie  algebra  with  the  identity  component 
of  the  corresponding  Lie  group  which  will  be  used  later  to  obtain  local  coor¬ 
dinates  for  a  neighborhood  of  the  identity  of  G.  Consider  the  integral  curve 
(/)£  :  M  — >  G  of  a  left- invariant  vector  field  X%,  (  6  g  passing  through  the  identity 
e  G  G  at  t  =  0.  The  map  (f)^  turns  out  to  be  a  homomorphism  from  K  to  G  for 
all  (Gg.  i.e.  it  is  a  one-parameter  subgroup  of  G. 

Definition  2.1.8  (Exponential  map)  The  exponential  map  exp  :  g  — >  G  is 

defined  by  setting 

exp  £  =  </>t(l). 

It  can  be  verified  that  exp(t£)  =  </>z(t),  i.e.  lines  t£,  t  6  I,  £  G  g  going 
through  the  origin  of  g,  are  mapped  onto  one-parameter  subgroups  of  G.  Con¬ 
versely,  every  one-parameter  subgroup  of  G  can  be  expressed  as  exp(tf  )  for  some 

(eg- 

Since  the  differential  d(exp)  :  TeG  — »  TeG  is  the  identity  map  on  TeG  we  can 
conclude  by  the  inverse  function  theorem  and  smoothness  of  exp  that  exp  is  a 
local  diffeomorphism  from  a  neighborhood  U  of  the  origin  of  g  onto  a  neighbor¬ 
hood  V  of  the  identity  of  G.  We  denote  the  inverse  map  of  exp  from  V'  to  U  by 
log  :  G  — >  g. 

Even  for  connected  Lie  groups  exp  is  in  general  neither  one-to-one  nor  onto. 
However,  there  exist  results  exhibiting  reasonably  large  neighborhoods  of  0  G  0 
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such  that  the  exponential  map  is  bijective  (see  pp.  110  of  (Varadarajan,  1974)). 
So,  for  a  given  basis  {£1, . . . ,  of  g  there  exists  a  reasonably  large  neighborhood 
U  of  the  origin  of  Rn  such  that  the  map 

<t>-U  ->  G;  (ai, . . . ,  an)  exp(a^i  H - h  an£n) 

is  a  smooth  diffeomorphism  onto  an  open  subset  <p(U)  C  G  containing  the  iden¬ 
tity.  Then,  the  smooth  functions  xi, . . . ,  xn  on  V  satisfying 

%i (exp(ai^i  H - h  an£n))  =  au  i  =  1, . . . ,  n;  Va  e  U 

are  called  the  canonical  coordinates  of  the  first  kind  or  single  exponential  coor¬ 
dinates  around  e  G  G  relative  to  the  basis  {£i, . . . ,  £n}. 

Another  set  of  canonical  coordinates  is  based  on  the  fact  that  there  exists  a 
U  C  Rn  such  that  the  map 

ip  :U  — M7;  (ai, . . . ,  an)  ^  exp(a^i)  •  •  -exp(an^n) 

is  a  diffeomorphism  onto  a  neighborhood  tp(U )  of  the  identity  of  G.  Since  in 
general  every  g  G  G  can  be  written  as  a  finite  product  •  •  •  <jk  of  elements 
gi, ,  gk  in  an  arbitrary  neighborhood  V  C  G  of  the  identity,  if  is  surjective  if 
we  take  U  =  Rn .  The  smooth  functions  x±, . . . ,  xn  on  if{U)  satisfying 

Xj(exp(ai6)  •  •  •  exp(an£n))  =  a*,  %  =  1, . . . ,  n;  Va  e  U 

are  called  the  canonical  coordinates  of  the  second  kind  or  product  of  exponentials 
coordinates  around  e  G  G  relative  to  the  basis  {£i, . . . ,  £n}. 


2.2  Matrix  Lie  groups 

Matrix  Lie  groups  whose  elements  represent  linear  isomorphisms  from  Rn  to  Rn 
provide  us  with  numeric  representations  of  abstract  Lie  groups.  Since  they  al- 
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ready  come  along  with  a  set  of  coordinates  (the  matrix  elements)  we  can  directly 
perform  computations  on  matrix  Lie  groups  and  use  the  geometrical  insight  and 
the  categorizations  by  canonical  forms  of  linear  algebra. 

The  most  general  matrix  Lie  group  is  the  general  linear  group  GL[n ,  R)  or 
GL{n,  C)  of  invertible  (n  x  n)-matrices  with  real  or  complex  entries,  respectively. 
In  the  following  we  will  focus  on  real  matrix  groups  unless  otherwise  noted  and 
denote  GL(n,  R)  simply  with  GL{n).  As  the  inverse  image  of  R\0  under  the 
continuous  map  X  det(X),  GL(n )  is  an  open  subset  of  Mn^n  =  M"2,  and  thus 
can  be  given  the  structure  of  a  differentiable  manifold.  The  group  multiplication 
of  GL(n )  is  the  regular  matrix  multiplication  and  the  inversion  map  takes  a 
matrix  X  in  GL(n )  to  its  inverse  X _1,  while  e  e  GL(n )  is  assumed  to  be  the 
identity  matrix  I  =  diag(l, . . . ,  1).  Since  GL(n )  is  an  open  subset  of  Mn>n,  the 
Lie  algebra  gl(n)  of  GL{n )  turns  out  to  be  Mn,n  with  the  Lie  bracket  defined  by 
the  matrix  commutator 

[A,  B]  =  AB  —  BA,  A,  Be  gl(ra) . 

All  other  real  matrix  Lie  groups  are  subgroups  of  GL{ri)  and  the  basic  operations 
of  GL{n )  and  gl(n)  like  the  group  multiplication  or  the  Lie  bracket  restrict 
accordingly  to  the  other  matrix  Lie  groups. 

The  exponential  map  for  a  matrix  Lie  group  G  turns  out  to  be  just  the  matrix 
exponential,  i.e.  given  an  element  A  e  G  we  write 

,°°  Ai  1 

exp(A)  =  eA  =  ^  —  =  I  +  A  +  -A2  +  •  •  • 

t=o  l' 

For  an  element  A  in  an  n-dimensional  matrix  group  whose  entries  are  bounded 
above  by  c  the  entries  of  A1  are  bounded  above  by  (cn)h  By  relating  this  to  the 
convergence  of  a  scalar  power  series  it  can  thus  be  established  that  the  matrix 


16 


power  series  above  converges  for  all  A  E  G.  For  a  matrix  Lie  group  G  the 
exponential  function  is  surjective  whenever  G  is  path-connected. 

The  matrix  logarithm,  the  inverse  of  the  matrix  exponential,  can  accordingly 
be  defined  as  a  matrix  power  series 

=  £(-!)•+■  =  (X  -  a  -  +  VLiH  T . . . 

i=  1 

for  X  in  a  neighborhood  of  e  =  I  E  G. 

In  the  following  we  list  for  future  reference  the  matrix  Lie  groups  appearing 
throughout  this  thesis  along  with  their  properties. 

Example  2.2.1  (Special  Linear  Group)  Let  SL(n )  denote  the  Special  Lin¬ 
ear  group  of  (n  x  n)-matrices  defined  by 

SL(n )  =  {X  e  GL(n)  \  det(X)  =  1}. 

The  Lie  algebra  sl(n)  of  SL(n )  is  defined  by 

sl(n)  =  {A  G  gl(n)  |  trace(A)  =  0} 

and  can  be  shown  to  be  simple.  SL(n )  is  of  dimension  n2  —  1,  non-compact,  and 
connected. 

Example  2.2.2  (Orthogonal  Group)  Let  0(n)  denote  the  Orthogonal  group 
of  matrices  defined  by 

O(n)  =  {X  e  GL(n )  |  XTX  =  1}. 

The  Lie  algebra  o(n)  of  O(n)  is  defined  by 

o(n)  =  {A  e  gl(n)  |  AT  =  —A}. 
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Example  2.2.3  (Special  Orthogonal  Group) Let  SO(n)  denote  the  Special  Or¬ 
thogonal  group  of  matrices  representing  rotations  in  an  n-dimensional  Euclidean 
space  defined  by 

SO{n )  =  {X  G  GL(n )  |  X  G  0{n)  D  SL(n)}. 

Since  SO(n )  is  just  the  identity  component  of  0(n),  the  Lie  algebra  so(n)  of 
SO(n)  equals  o (n).  SO[n )  is  of  dimension  — simple,  compact,  and  con¬ 
nected. 


Example  2.2.4  (Special  Euclidean  Group)  Let  SE(n)  denote  the  Special 
Euclidean  group  of  rigid  motions  in  n-dimensional  Euclidean  space  defined  by 


SE(n )  = 


^  X  p^ 


0 


1  xn 


l 


G  GL{n  +  1)  |  X  G  SO(n),p  G  Mn|. 


The  Lie  algebra  sc(n)  of  SE[n )  is  defined  by 

5C(n)  =  i  \  |  G  0l(n)  j  A  G  so(n),p  G 


^  0lxn  0  J 

SE{n )  is  of  dimension  n(n+1) ^  non-compact,  and  connected.  SE[2)  is  solvable. 

Example  2.2.5  (Group  of  Unipotent  Matrices)  Let  UP{n )  1  denote  the 
group  of  upper-triangular  (n  x  n)—  matrices  X  with  diagonal  elements  Xvl  = 
1;  i  =  1, . . .  n.  The  Lie  algebra  up(n)  of  UP(n )  then  consists  of  upper  triangular 
matrices  A  with  diagonal  elements  An  =  0;  i  —  1, . .  .n.  It  can  be  verified  that 
UP[n )  is  of  dimension  tAnzAl  ancj  js  nilpotent.  Since  we  can  use  the  elements 
Xl3-i  <  j  directly  as  global  coordinate  functions  for  UP(n),  the  manifold  under¬ 
lying  UP(n )  is  diffeomorphic  to  M  (  2  } .  Therefore  UP{n )  is  not  compact,  but 
simply  connected. 

1This  is  non-standard  notation. 
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2.3  Systems  on  matrix  Lie  groups 

An  affine  control  system  on  a  n-dimensional  Lie  group  G  is  defined  by  an  affine 
combination  of  vector  fields  on  G 

m 

g(t )  =  XQ(g(t))  +  y 'ui(t)Xi(g(t)),  m  <  n,  Ui(t )  <E  R  (2.6) 

i= 1 

where  g(t)  is  a  curve  on  G,  X0  is  interpreted  as  the  drift  vector  field  and  Xi:  i  = 
1, . . .  ,m  are  interpreted  as  control  vector  fields.  We  focus  in  this  thesis  on  the 
case  where  the  vector  fields  Xi,i  =  0,1, . . .  ,m  are  left-invariant  and  also  call  the 
corresponding  system  (2.6)  left-invariant.  Following  (2.2)  a  left-invariant  control 
system  on  G  can  be  written  as 

m 

g(t)  =  TeLg[t)(i  o  +  «*(*)&)  (2.7) 

i= 1 

where  £0>£i)  •  •  -  Cm  are  fixed  vectors  in  the  Lie  algebra  g  of  G.  If  £0  =  0,  the 
system  (2.7)  is  called  drift-free.  Since  the  tangent  lift  TeL\,X  G  G  of  the  left 
shift  operation  for  matrix  Lie  groups  is  equal  to  Lx  itself,  a  left- invariant  system 
on  a  n-dimensional  matrix  Lie  group  can  be  expressed  as 

m 

X(t)  =  X(t)U(t )  =  X(t)  Ui(t)Ai,  m  <  n  (2.8) 

i 

where  X(t)  is  a  curve  in  G,  U(t )  is  a  curve  in  g  and  {A\, . . . ,  A,,}  is  assumed  to 
be  a  basis  for  g.  We  write 

m 

Y(t)  =  U(t)Y(t)  =  Ui(t)At)Y  (2.9) 

i 

for  the  corresponding  right- invariant  system. 

From  (2.4)  it  follows  that  solution  Y(t)  of  (2.9)  satisfies 

ft(Y-1)(t)  =  Y~1(t)(-U(t)).  (2,10) 
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Therefore,  a  right-invariant  control  system  on  a  Lie  group  G  can  easily  be  con¬ 
verted  to  a  left- invariant  control  system  on  G. 

Turning  to  the  question  of  controllability  of  (2.7)  we  define  the  set  1A  of 
admissible  controls  as  the  class  of  locally  bounded,  measurable  functions  from 

[0,  oo)  to  r. 

Definition  2.3.1  (Controllability)  The  system  (2.7)  is  called  controllable  if 

for  any  go,  51  £  G  there  exists  a  time  T  >  0  and  an  admissible  control  u  G  U 
such  that  the  corresponding  solution  of  (2.8)  satisfies  g( 0)  =  go  and  g(T )  =  g\. 

The  following  two  theorems  by  Jurdjevic  and  Sussmann  (Jurdjevic  &  Suss- 
mann,  1972)  demonstrate  how  controllability  of  (2.7)  can  be  checked  by  studying 
the  algebraic  properties  of  g  and  topological  properties  of  the  group  manifold. 

Theorem  2.3.2  (Controllability  for  Drift-Free  System)  Let  E  denote  a  drift-free 
system  of  the  form  (2.7)  on  a  connected  Lie  group  G.  Then  E  is  controllable  if 
and  only  if  the  Lie  algebra  generated  by  {£i, . . . ,  £m}  spans  g. 

Theorem  2.3.3  (Controllability  for  System  with  Drift)  Let  E0  denote  a  system 
with  drift  of  the  form  (2.7)  on  a  compact,  connected  Lie  group  G.  Then  E0  is 
controllable  if  and  only  if  the  Lie  algebra  generated  by  {£o,£i, . . .  ,£m}  spans  g. 

The  corresponding  controllability  results  for  (2.8)  can  be  obtained  by  replac¬ 
ing  g(0),g(T),^j  in  Theorem  (2.3.2)  and  Theorem  (2.3.3)  by  X(0),  X(T),  Ah 
respectively. 
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2.4  Local  representations  of  systems  on  Lie  groups 


Even  though  important  results  for  systems  on  matrix  Lie  groups,  e.g.  controlla¬ 
bility,  can  be  established  directly  from  the  algebraic  and  geometric  properties  of 
their  global  description  (2.8),  we  need  to  resort  to  local  representations  of  (2.8) 
when  we  compute  the  actual  control  laws. 

Given  a  n-dimensional  Lie  group  G  we  pick  a  diffeomorphism  from  a  neigh¬ 
borhood  U  of  e  e  G  to  neighborhood  V  of  0  €  ,  k  >  n  which  induces  a  local 

representation  of  (2.8)  as  a  affine  system 

X  =  fo(x)  +  fi(x)ui -t - f  fm(x)um,  x  G  Kn .  (2.11) 

Note  that  distributions  spanned  by  the  /*,  i  =  0, 1, . . . ,  m  are  of  constant  dimen¬ 
sion  or  regular  on  V  since  they  originate  from  invariant  vector  fields  on  G. 

Criteria  for  a  desirable  local  representations  include: 

•  coordinates  have  a  large,  well  defined  region  of  validity; 

•  representation  is  in  terms  of  explicit  functions; 

•  representation  reflects  structural  properties  of  (2.8); 

•  representation  has  good  numerical  properties  with  respect  to  integration; 

•  coordinates  have  physical  interpretation. 

In  the  following  we  will  present  such  local  representations  and  discuss  their 
advantages  and  disadvantages  in  terms  of  the  criteria  stated  above. 
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2.4.1  Single  exponential  representation 

Given  a  basis  B  =  {Ai,  A2, . . . ,  An}  for  the  Lie  algebra  g  of  a  n-dimensional 
matrix  group  G,  the  canonical  coordinates  of  the  first  kind  zi:  z2,  ■  ■  ■ ,  zn  relative 
to  B  satisfy 

X  =  Q Z  =  - l-Zn,  An 

for  X  in  V,  a  neighborhood  of  e  G  G.  Via  the  tangent  lift  of  the  coordinate  map, 
the  left- invariant  control  system  X(t)  =  X(t)  YlTui(^)Ai  then  induces  a  control 
system  on  Rn.  This  local  representation  of  (2.8)  was  characterized  by  Magnus 
(Magnus,  1954).  Adhering  to  our  convention  we  will  present  a  /e/i-invariant 
version  of  Magnus’s  result  without  proof. 


Theorem  2.4.1  (Magnus)  Consider  the  left-invariant,  drift-free  system  (2.8) 
on  a  matrix  Lie  group  G  and  the  single  exponential  representation  Z(t),  t  >  0  of 
its  solution.  Then,  if  certain  unspecified  conditions  of  convergence  are  satisfied 
Z(t)  can  be  written  in  the  form 

adz(t) 


Zit)  = 


1  -  exp (~adz (t)) 


m 


=  (I  +  \adm+X,((ffadf(t))U(t'l 

=  U(t)  +  l[Z(t),  U(t)]  +  L[Z(t),  [Z(t),  (/(()]] 


(2.12) 


720 


[Z(t),[Z(t),[Z(t),U(t)}}}±... 


where  the  fop  are  Bernoulli  numbers. 


We  will  call  a  local  representation  of  the  form  above  the  single  exponential  or 
alternatively  the  Magnus  representation  of  (2.8). 
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Example  2.4.2  Consider  the  left-invariant  system  (2.8)  on  the  Special  Eu¬ 
clidean  group  SE( 2)  with  a  basis  {A\,  A2,A3}  for  g  chosen  such  that 

[Ai,  A2\  =  A3,  [A{ ,  A3]  =  —A2,  [^2,^43]  =  0. 

With  U(t)  =  ui(t)A1  +  u2(t)A2  and  Z(t)  =  z\(t)A\  +z2(t)A2  +  z3[t)A3  the  single 
exponential  representation  of  this  system  can  be  written  as 

=  ul(t)A1  +  u2(t)A2  +  ^(zi(t)v,2(t)  -  z2(t)u1(tj^A3 

-  z{(t)u2(t)^jA2  ±  . . . 

or  due  to  the  linear  independence  of  the  basis  vectors  Ai:  i  =  1,  2, 3  as 
Zl  =  Ml 

12  =  U2  +  (z^ux  -  z{u^j  ±  . . . 

13  =  ^ (zxu2  -  z2u^j  ±  .... 

For  the  system  (2.8)  on  50(3)  the  single  exponential  coordinates  turn  out  to  be 
the  Euler  parameters  for  50(3). 

Note  that  if  g  is  nilpotent  of  order  k  then  the  infinite  sum  terminates,  and 
we  need  only  consider  the  first  k  +  1  terms  on  the  right  hand  side.  Moreover,  in 
the  general  situation  the  rapidly  decreasing  coefficients  on  the  right  hand  side 
of  (2.12)  suggest  that  the  original  system  can  be  approximated  reasonably  well 
by  truncating  the  series  expansion  for  Z(t)  after  a  finite  number  of  terms.  In 
particular,  if  we  start  with  a  suitably  ordered  basis  for  g  one  can  determine  a 
nilpotent  approximation  of  a  non-nilpotent  system  (2.8)  by  truncating  (2.13) 
after  the  leading  term  for  each  xr ,  %  =  1,2,3, ...  ,n.  The  resulting  approxima¬ 
tion  has  the  same  growth  vector  as  the  original  system  and  is  of  relevance  as 
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a  nilpotent  model  system  for  nilpotentization  or  local  exponential  stabilization 
(see  Chapters  5  and  6). 

Another  feature  of  single  exponential  representations  is  that  the  solution  of 
the  Magnus  equation  (2.12)  can  be  written  as  a  series  of  quadratures  involving  U 
using  the  so  called  Fomenko- Chakon  recursive  expansion  (Fomenko  &  Chakon, 
1991).  It  can  be  understood  as  a  continuous  version  of  the  Baker-Campbell- 
Hausdorff  formula  and  is  presented  here  in  its  left-invariant  version. 


Theorem  2.4.3  (Fomenko-Chakon)  Let  7  =  {U(s),0  <  s  <  t}  be  a  Rie- 
mann  integrable  curve  in  Lie  algebra  Q  and  assume  that 

b 


\U(s)\ds  < 


M' 


where  b  <  2ir  and  M  is  chosen  such  that  ||[X,  F]||  <  M||X||  ||y|| ,  VX,  Y  e  Q. 
Then  (2.8)  has  a  solution  of  the  form  X(t )  =  ez<^AT(0)  which  satisfies  (2.8)  at 
each  t  for  which  lini/w0  f*+h  U(s )  =  U(t),  where 


m  = 


(2.13) 


i— 1 


converges  and  {Z*(t)}  is  uniquely  defined  by  the  recursion  formulas 

Z,H)  =  f  U(s)ds, 


(2.14) 


and  for  n  >  1 ,  with  T0  =  Z\ 

(i  —  1  =  Tj  +  y  ^  |  —  [Zr ,  Tj_r\ 

r= 1 

+  Y  k*r  Y  [^mli  '  j  [Zm2pi  Tn— r]  '  ’  ’]  j- 1 

p>l,  2p<r  m,i>0,  mjH - \-m,2p=r 

where  k2p(2p)\  are  Bernoulli’s  numbers  and  for  k  >  1 

t  Tfc  +  l  T2 

Tk{t)  =  {-l)k  J  J  ...  j  [U(T1),[U(T2),...,[U(Tk),U(rk+1)}---])dT1---dTk+1 

Tk+1=0rk=0  ri=0 
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or  equivalently 


t 
/ * 

n 

/» 

Tk- 1 
/» 

/» 

T„(t)=  j 

U(t i).  /  U(t2) 

,•••  /  U(n) 

,J  U(Tk+1) 

T\  —0 

. 

. 

-r2=0 

Tk=  0 

Tk+ 1 

■  dri- 


2.4.2  Product  of  exponentials  representation 

Given  a  basis  B  =  {A\,  A2j  ,  4n}  for  the  Lie  algebra  g  of  a  n-dimensional  ma¬ 
trix  group  G,  the  canonical  coordinates  of  the  second  kind  x\,  x2,  ■ . . ,  xn  relative 
to  B  satisfy 

—  g^l^l  gx2^2  .  .  .  gln^n 

for  X  in  V,  a  neighborhood  of  e  E  G.  Via  the  tangent  lift  of  the  coordinate 
map,  the  left-invariant  control  system  X(t)  =  X(t)  Y2T  ui(t)Ai  then  induces  a 
control  system  on  Rn,  which  was  characterized  by  Wei  and  Norman  (Wei  & 
Norman,  1964).  In  the  following  theorem  we  use  an  extended  control  vector 
u  =  un)T  with  Ui  =  0,  i  —  m  +  1, . . . ,  n. 


Theorem  2.4.4  (Wei— Norman)  Consider  the  system  (2.8)  and  its  solution 
X(t),  t  >  0.  Then,  in  a  neighborhood  oft  =  0  the  solution  may  be  expressed  in 
the  form 

X(t)  =  eMt)Alex2(t)A2  .  .  .  g xn(t)An  (2.15) 


The  coordinate  functions  Xi(t )  evolve  according  to 


^  xi(t)  ^ 


\  xn(t)  J 


=  M(x i,  ...,xn) 


(  Ui  (t)  ^ 


y  un(t)  J 


(2,16) 


where  M  is  analytic  in  the  coordinates  Xi  and  depends  only  on  the  structure  of 
the  Lie  algebra  Q . 
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Moreover,  if  Q  is  solvable,  then  there  exists  a  basis  and  an  ordering  of  this 
basis  for  which  the  representation  (2.15)  is  global  and  the  Xi  can  be  computed  by 
quadratures. 

Example  2.4.5  The  product  of  exponentials  representation  for  the  left-invariant 
system  (2.8)  on  SE(2)  specified  in  Example  2-4-2  turns  out  to  be 


X\  =  U\ 

X2  =  U2  +  X3U1 

X3  =  ~x2u  1 


(see  Chapter  5).  The  product  of  exponentials  coordinates  for  SO(3)  are  equiva¬ 
lent  to  the  Euler  angles. 

For  all  systems  considered  in  this  dissertation  the  product  of  exponentials 
coordinates  lead  to  simple  local  representations  in  terms  of  explicit  functions. 
These  coordinates  have  the  additional  advantage  that  we  are  guaranteed  a  global 
quadrature  solutions  for  systems  on  solvable  Lie  groups.  Since  chained  form 
systems  are  themselves  in  product  of  exponentials  form  this  representation  is 
especially  suitable  for  feedback  nilpotentization  to  chained  form. 
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2.5  Example  Systems  on  Matrix  Lie  Groups 


In  this  section  we  demonstrate  how  systems  on  matrix  Lie  groups  arise  as  models 
for  the  kinematics  of  mechanical  systems  and  outline  how  certain  assumptions 
on  the  actuators  are  reflected  in  the  Lie  group  model. 

Another  source  for  systems  on  matrix  Lie  groups  can  be  found  in  conservation 
laws  governing  physical  processes  such  as  in  electronics  or  quantum  mechanics. 
Other  examples  for  systems  on  matrix  Lie  groups  of  interest  but  not  included  in 
the  following  list  are  switching  circuits  for  power  conversion  leading  to  systems 
on  SO(n )  (Wood,  1974),  multi-level  systems  used  to  model  molecular  bonds  in 
the  context  of  coherent  control  of  quantum  dynamics  leading  to  system  on  SU{n ) 
with  drift  (Dahleh  et  al. ,  1996),  a  body- mass  system  used  to  model  a  satellite 
with  flexible  attachments  leading  to  a  system  on  .SO^)  x  R2  (Yang,  1992), 
the  model  of  a  kinematic  car  leading  to  a  non- invariant  system  on  SE( 2)  x  M 
(Leonard,  1994),  and  so  called  (7-Snakes  modeling  chains  of  rigid  transformations 
(Tsakiris,  1995). 

2.5.1  Rigid  motions  on  W1 

Let  E0  be  an  inertial  frame  for  Mn  and  E&  be  a  frame  fixed  to  a  rigid  body.  Then 
a  rigid  motion  of  the  body  can  be  described  by  the  motion  of  the  body  frame  E& 
relative  to  E0  or,  more  directly,  by  the  coordinate  transformation  relating  the 
coordinates  of  a  point  with  respect  to  the  body  frame  E b  to  its  coordinates  with 
respect  to  the  inertial  frame.  In  particular,  the  motion  of  a  material  point  p  of 
the  body  can  be  written  as 

ps  =  X(t)pb 
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where  X ( t )  is  a  transformation  matrix  and  ps  and  pb  are  the  coordinates  of  the 
point  with  respect  to  the  inertial  and  body  frame,  respectively. 

If  the  specific  rigid  motion  involves  translatory  motion,  ps  and  pb  are  written 
in  homogeneous  coordinates  to  obtain  the  coordinate  transformation  in  matrix 
form. 

The  velocity  of  a  point  p  with  respect  to  £0  is  given  by 

vs  =  X(t)pb  =  X(t)  X~l{t)ps, 

and  we  call  Vs  =  X{t)X~1{t)  the  spatial  velocity  of  the  rigid  motion  in  matrix 
form. 

By  noting  that  the  velocity  vs  of  a  material  point  p  expressed  in  body  coor¬ 
dinates  is 

vb  =  X~lvs  =  X-\f)X{f)qb 

we  define  the  body  velocity  of  the  rigid  motion  (in  matrix  form)  to  be  b,  = 
X-'(t)X(t). 

Depending  on  the  type  of  actuation  we  write  the  kinematics  of  a  mechanical 
system  either  in  terms  of  Vs  or  Vb  For  body-fixed  actuation,  as  found  for  instance 
in  the  case  of  a  satellite  with  body-fixed  thrusters,  it  is  convenient  to  model  the 
kinematics  in  terms  of  14.  The  motion  is  then  characterized  by  a  left- invariant 
system 

X(t)  =  X(t)Vb(t)  X  e  G 

where  G  is  the  matrix  Lie  groups  corresponding  to  the  respective  rigid  motion 
and  Vb  lies  in  TeG  accordingly. 

Similarly,  in  the  case  of  spatially-fixed  actuation  it  is  convenient  to  write  the 
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kinematics  as  the  right-invariant  system 


X(t)  =  Vs(t)X(t),  X  e  G. 

We  will  view  the  velocities  V&(t)  and  Vs(t)  as  a  matrix- valued  input  and  denote 
them  in  the  following  simply  by  U(t). 

2.5.2  Unicycle 

Let  us  consider  a  simplified  model  of  a  unicycle,  where  we  just  model  the  wheel 
which  is  assumed  to  roll  without  slipping  on  a  plane  with  the  wheel  axis  always 
parallel  to  the  plane.  Further  we  assume  that  we  have  control  over  the  forward 
velocity  as  well  as  the  steering  velocity,  which  describes  the  angular  velocity  of 
the  wheel  around  a  line  through  the  point  of  contact  and  perpendicular  to  the 
plane. 


Figure  2.1:  Overhead  view  of  unicycle 

Let  Eo  be  an  inertial  frame  in  R2  and  E &  a  frame  attached  to  the  wheel  as 
shown  in  Figure  2.1.  Then  the  matrix  X  G  SE(2)  relating  the  homogeneous 
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coordinates  of  a  point  in  body  coordinates  to  its  coordinates  with  respect  to  the 
inertial  frame  E(J  is  of  the  form 


^  cos  (j)  —  sin  (j)  x  ^ 


X  = 


V 


sin  0  cos  4>  y 

0  0  1 


/ 


while  the  body  velocity  V&  G  se( 2)  turns  out  to  be  of  the  form 


^  0  ~~00  Vr  ^ 


Vb  = 


oo  0  v,. 


0  0  0 


With  a  basis  {A1:  A2,  A3}  for  se( 2)  dehned  by 


^  0  -1  0  ^ 


Ai  = 


1  0  0 
0  0  0 


^001^ 


A 9  — 


V 


0  0  0 
0  0  0 


/ 


the  kinematics  of  the  unicycle  can  be  written  as 


A-\  — 


0  0  0 
0  0  1 
0  0  0 


\ 


A  —  X(u\Ai  +  U2A2), 


(2.17) 


where  u\  and  u2  are  the  steering  and  forward  velocity,  respectively. 

Since  [Ai,  A2]  =  A3 ,  i.e  the  input  vectors  A3,A2  generate  the  Lie  algebra 
se(2)  (2.17)  is  controllable  by  Theorem  2.3.2. 

Equation  (2.17)  describes  generic  nonholonomic  motions  on  the  plane  and 
can  for  instance  be  used  to  represent  the  kinematics  of  a  elementary  hovercraft 
model  if  A\  and  A2  are  chosen  to  reflect  the  constellation  of  actuators. 
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2.5.3  Spacecraft 


In  the  spacecraft  attitude  control  problem  we  restrict  our  attention  to  the  ori¬ 
entation  of  the  satellite  with  respect  to  a  reference  frame  E0  and  assume  that 
the  origin  of  the  frame  E&  coincides  with  the  origin  of  E0.  We  assume  that  the 
actuators  of  the  satellite,  say  thrusters  or  momentum  wheels,  are  fixed  to  the 
body  such  that  resulting  angular  velocity  vectors  are  aligned  with  the  orthonor¬ 
mal  body  frame  Et  (see  Figure  2.2).  Further  we  make  the  idealizing  assumption 
that  the  we  have  direct  control  over  the  angular  velocities  resulting  from  the 
actuators. 


Figure  2.2:  Satellite  actuated  by  momentum  wheels 


The  configuration  of  the  spacecraft  can  thus  be  specified  by  the  transforma¬ 
tion  X  G  SO (3)  relating  body  coordinates  to  reference  coordinates,  while  the 
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body  angular  velocity  Vf,  =  X  1X  =e  so (3)  can  be  written  as 


^  0  — UJ3  U>2  ^ 


vb  = 


V 


UJ3  0 

—U>2  UJi 


-U>1 

0 


where  uol  is  the  magnitude  of  the  angular  velocity  around  the  axis  k; .  Choosing 
a  basis  {Ai,  A2,  A3}  dehned  by 


A\  — 


^00  0 
0  0-1 
v  0  1  0 


\ 

/ 


A2 


(  0  0  1 N 
0  0  0 

V  -1  0  0  ) 


A3 


( 0  -1  0  ^ 
1  0  0 
v  0  0  0  f 


for  so  (3)  we  define  the  corresponding  left-invariant  by  control  system  on  SO (3) 
by 

X(t)  =  X  (t)  Ai  +  v,2(t)A2  +  (2.18) 


In  this  dissertation  we  are  interested  in  the  case  where  one  of  the  controls 
Ui  in  (2.18)  is  identically  equal  to  zero,  due  e.g.  to  a  failure,  which  specifies 
a  nonholonomic  constraint  for  the  evolution  of  X(t)  on  SO( 3).  Without  loss 
of  generality  we  assume  «3  =  0  and  study  motion  control  of  the  corresponding 
system 

X(t)  =  X  (t)  A\  +  U2(t)A2).  (2.19) 

Since  [Ai,  A2]  =  A3,  i.e  the  input  vectors  AlyA2  generate  the  Lie  algebra 
so(3),  (2.19)  is  controllable  by  Theorem  2.3.2. 

Equation  (2.19)  also  serves  as  a  model  for  the  so  called  ball  and  plate 
system  which  was  proposed  as  a  vibratory  actuator  in  (Leonard,  1994). 
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2.5.4  Underwater  Vehicle 


The  configuration  of  an  underwater  vehicle  is  modeled  as  the  position  and 
orientation  of  a  body-fixed  E&  =  (bi,  b2,  b3)  with  respect  to  an  inertial  frame 
E0  =  (x,  y,  z)  (see  Figure  4.1).  We  assume  that  the  individual  actuators  are  con¬ 
figured  such  that  the  resulting  angular  and  linear  velocities  are  aligned  with 
the  body  frame  E&.  The  configuration  of  the  underwater  vehicle  can  thus 
be  specified  by  an  element  X  G  SE( 3),  and  the  corresponding  body  velocity 
Vb  =  X~xX  =£  se(3)  can  be  written  as 


Vb 


{  0  — CU3  U>2  V\  ^ 

U>3  0  —U>i  V2 

—U>2  0  V3 

y  0  0  0  0  y 


where  u>i,  i  =  1.2,3  is  the  magnitude  of  the  angular  velocity  around  the  axis  bt 
and  Vi,  i  =  1,2,3  represent  the  linear  velocities. 


Figure  2.3:  Underwater  vehicle 
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Choosing  a  basis  {Ai, . . . ,  A6}  for  sc(3)  defined  by 
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0  0  0  0 
0  0  0  0 
0  0  0  0 


^  0  0  0  0  ^ 


A*  — 


An  = 


0  0  0  1 
0  0  0  0 
0  0  0  0 

we  end  np  in  the  fully  actuated  case  with  the  left-invariant  control  system  on 
SE( 3)  dehned  by 


V 


^  0  0  0  0  ^ 


) 


0  0  0  1 
0  0  0  0 
0  0  0  0 


X[t)  —  X(t)(ui(t)Ai  +  . . .  +  ue(t)Ao). 

The  underwater  vehicle  is  controllable  with  as  few  as  two  inputs  (for  details  see 
Chapter  5). 
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Chapter  3 


Approximate  Inversion 


This  chapter  serves  to  introduce  the  concept  of  approximate  inversion  of  non- 
holonomic  systems  and  to  provide  some  motivation  for  the  approaches  taken  in 
subsequent  chapters.  In  the  first  section  we  define  the  problem  of  constructive 
controllability  for  nonholonomic  systems  and  the  notion  of  an  approximate  in¬ 
verse  dynamical  system.  Using  the  example  of  a  simple  three-dimensional  system 
we  study  in  the  following  sections  different  ways  to  formulate  such  approximate 
inversion  control  laws  and  related  issues  of  optimality.  Some  of  the  ideas  pre¬ 
sented  in  this  introductory  chapter  can  already  be  found  in  (Brockett,  1993). 

3.1  Problem  Definition 

It  has  been  one  of  the  achievements  of  linear  systems  theory  to  establish  generic 
methods  to  construct  explicit  steering,  tracking  and  stabilization  control  laws 
directly  from  the  vector  fields,  i.e.  the  columns  of  the  controllability  Gramian 
used  to  establish  controllability  for  a  given  linear  system.  No  such  methods  exist 
for  generic,  controllable,  nonlinear  systems,  but  considerable  progress  has  been 
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made  for  drift-free,  input-linear  systems  of  the  type 


x  =  ^2  Mx)uh  x  <ERn.  (3.1) 

i= 1 

Under  the  heading  of  constructive  controllability  two  types  of  control  problems 
for  such  systems  are  considered: 

Point-to-Point  Problem:  Given  any  pair  of  points  Xq,X\  G  Rn  hnd  a  control 
u(-)  steering  the  state  of  (3.1)  from  x0  at  time  t  —  0  to  x\  at  some  time 
t  —  ti  >  0. 

Approximate  Tracking  Problem  Given  a  sufficiently  smooth  trajectory  x  : 
[0,T]  — »  Rn  hnd  controls  u(-)  steering  the  state  x(t),t  G  [0, T]  of  (3.1) 
approximately  (in  a  sense  to  be  made  precise  below)  along  x. 

We  will  focus  in  this  dissertation  on  the  approximate  tracking  problem  for  sys¬ 
tems  (3.1)  arising  as  local  representations  of  invariant  systems  on  matrix  Lie 
groups  or  equivalently  on  approximately  tracking  a  desired  trajectory  g  :  [0,  T]  — >• 
G  in  a  neighborhood  of  a  point  g0  G  G. 

In  order  to  formalize  the  concept  of  approximate  inversion  we  start  by  char¬ 
acterizing  tracking  controls  for  nonholonomic  systems. 

Definition  3.1.1  Let  x  :  [0,  T]  — »  Rn  be  a  sufficiently  smooth  desired  trajectory 
for  system  (3.1)  and  assume  that  x(0)  =  x0.  Let  u^w\t)  =  f(t,u,x(t),x(t),x(t)) 
be  a  control  law  parameterized  by  a  parameter  u>  depending  instantaneously  on 
x,  x  and  x  at  time  t.  If  the  sequence  of  trajectories  of  (3.1)  resulting  from 

the  sequence  of  inputs  satisfies 

lim  x^\t)  =  x(t),  Vt  G  [0,  T] 

(U— >00 
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where  the  above  convergence  is  uniform  with  respect  to  t  £  [0,  T],  then  we  call 
an  approximate  tracking  control.  If  moreover  is  independent  of  the  state 
x  of  (3.1)  we  call  an  open-loop  approximate  tracking  control. 

The  instantaneous  dependency  on  the  desired  trajectory  x  is  a  crucial  feature 
of  this  type  of  controls,  since  it  allows  on-line  control  of  drift-free  nonholonomic 
systems  with  an  “on-the-fly”  trajectory  generator.  If  we  are  given  x(t)  and  x{t) 
as  inputs  we  can  therefore  model  the  approximate  tracking  control  law  as  an 
input-output  map  E_1  :  Rn  — >  M.m  ]x(t)  i— >  u(t )  involving  only  the  differentiation 
of  x(t )  and  a  subsequent  nonlinear  map  with  an  explicit  time  dependence. 

If  this  input-output  map  is  independent  of  x(t)  then  it  can  be  interpreted  as 
a  dynamical  system  independent  of  (3.1).  Following  Brockett,  we  call  such  an 
input-output  description  of  an  open-loop  approximate  tracking  control  law  the 
approximate  inverse  of  the  original  system  E.  This  terminology  is  motivated  by 
the  fact  that  the  concatenation  of  the  approximate  inverse  E_1  with  the  original 
system  E  yields  the  approximate  identity  operator  in  path  space: 

x(t )  =  E^Ejx(x)  j  =  x  +  o(cn"),  t  €  [0,  T],  a  <  0. 


X 

Approximate 

u 

Original 

X 

Inverse 

System 

\. 


Approximate  Identity  Operator 


Figure  3.1:  Interpretation  of  open-loop  approximate  tracking  control  law  as  ap¬ 
proximate  inverse  operator  in  space  of  state  trajectories 
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The  interpretation  of  SoE-1  as  an  approximate  identity  operator  has  impor¬ 
tant  consequences  for  the  problem  of  asymptotic  point  stabilization  of  a  drift-free 
nonholonomic  system  which  will  be  explored  in  Chapter  6. 


3.2  Open-loop  tracking  for  the  nonholonomic 
integrator 


Consider  the  left-invariant  drift-free  system 


X(t)  =  X(t)  (wi(i)Ai  +  u2(t)A2), 


(3.2) 


on  the  Heisenberg  group  H( 3),  where  X  G  H( 3)  is  of  the  form 

A  ai  a3  ^ 


X  = 


and  where  we  have  fixed  a  basis 


V 


0  1  a2 
0  0  1 


^010^ 


Ai  — 


V 


0  0  0 
0  0  0 


^  0  0  0  ^ 


Ao  — 


1 


\ 


/ 


Art  — 


) 


V 


0  0  1 
0  0  0 
0  0  0 


\ 


J 


0  0  1 
0  0  0 

for  f)(3).  Since  =  A3,  (3.2)  is  controllable  by  Theorem  2.3.2. 

The  single  exponential  representation  of  (3.2)  is  globally  valid  and  turns  out 
to  be 


Xi 

=  Ui 

X2 

=  u2 

(3.3) 

X3 

=  ^(xi«2  -  X2«i). 
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Despite  its  simplicity  the  system  (3.3)  already  exhibits  some  of  the  fundamental 
features  and  problems  encountered  in  motion  control  of  nonholonomic  systems. 
Following  Brockett  we  call  (3.3)  the  nonholonomic  integrator. 

While  the  states  x\  and  x 2  of  (3.3)  can  be  controlled  directly  as  the  indefinite 
integrals  of  u\  and  U2,  we  can  also  assign  a  geometric  meaning  to  the  evolution 
of  x3.  Assuming  £3(0)  =  0  and  rewriting 

x3(t)  =  7:  I  X!U2  -  x2uldr  =  7:  f  XiX2  -  x2xidr  (3.4) 

^  Jo  ^  Jo 

as  a  line  integral 

x3(t)  =  —  I  —x2dxi  +  x\dx2  =  j  u  (3.5) 

2  Jct  Jct 

we  see  that  £3 (t)  is  the  integral  of  the  solenoidal  vector  held  with  components 
F  1  ( £  1 , £2)  =  -£2,  F2(x i,£2)  =  Xi  along  the  path  Ct  =  (x1(t),x2(t)),  t  e  [0,£] 
of  the  states  x\  and  x2  in  the  (£1,  £2)-plane  (see  Figure  3.2). 


Figure  3.2:  Interpretation  of  evolution  of  £3  as  line  integral 

Assuming  that  C  is  closed,  i.e.  (xi(T),  x2(T))  =  (^(O),  £2(0))  for  some  T 
and  encloses  the  surface  R  in  the  (xi,  £2)-plane  positively,  we  can  apply  Green’s 
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theorem  to  obtain 


dx\dx2  =  a(R ) 


(3.6) 


where  a(R )  is  the  area  of  the  surface  R  (see  Figure  3.3).  As  pointed  out  in 
(Leonard,  1994),  also  for  the  generation  of  motion  along  higher-order  brackets  a 
geometric  interpretation  is  possible. 


Figure  3.3:  Interpretation  of  evolution  of  x 3  as  surface  integral 

From  (3.5)  or  Figure  3.2  we  see  that  the  only  paths  of  X\  and  X2  in  the 
(xi,  x2)-plane  which  leave  X3  constant  are  on  lines  through  the  origin  of  the 
(xi,x2)-plane.  On  the  other  hand,  away  from  the  origin  in  the  (xi, x2)-plane 
any  smooth  trajectory  X3  can  be  tracked  exactly  with  X3  by  specifying  a  suitable 
trajectory  in  the  (xi,  x2)-plane. 

Equation  (3.6)  shows  how  to  achieve  a  secular  motion  for  X3  while  staying 
close  to  an  initial  point  in  the  (xi,  X2)-plane.  Using  a  T-periodic  control  u(t)  = 
(ui(£),  u2(t))T ,  t  >  0  the  projection  of  the  resulting  trajectory  onto  the  (xi,x2)- 
plane  traverses  successively  a  loop  1  which  encloses  a  surface  with  area  A.  Thus 

1For  the  sake  of  simplicity  we  assume  simple  loops  here,  i.e.  there  is  no  t  €  (0,  T)  such  that 


(x1(t),x2(t))  =  (xi(0),x2(0)). 
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by  (3.6) 


£3 (nT)  =  ±nA,  n  =  1,2,...  ,  (3.7) 

where  the  sign  depends  on  the  direction  in  which  the  loop  is  traversed.  Note 
that  while  the  trajectory  of  £3 (t)  changes  for  t  ^  nT  if  we  vary  £i(0)  and  £2(0), 
equation  (3.7)  is  independent  of  the  initial  location  in  the  (£1,  £2)-plane,  since 
the  area  enclosed  by  the  loop  depends  only  on  the  form  of  u  but  not  on  £(0). 

Moreover  if  we  scale  the  amplitude  and  the  time-dependence  of  control  u 
such  that  u(t )  =  au(kt ),  a  >  0,  k  >  0  then  we  have  for  the  resulting  state  £3 
that 

£3(nT)  =  ±ka2nA,  n  —  1,2,....  (3.8) 

Letting  a  =  -^=  for  an  integer  k  >  1  we  have  x3(nT)  =  x3(nT)  while 

£j(f)  —  £*(0)  =  I  Vku(kr)d,T  =  —=  f  u(r)dr 

Jo  Vk  Jo 

=  -^=(xj(f)  -  £i( 0)),  i=l,2 

where  we  have  assumed  £,(0)  =  £,;(()).  Thus,  increasing  the  frequency  of  a 
periodic  control  by  a  factor  k  and  scaling  the  amplitude  as  above  yields  the 
same  secular  motion  for  £3  while  reducing  the  deviation  of  £j(t),i  =  1,2  from 
£j(0),i  =  1,2  respectively  by  a  factor 

This  simple  example  reveals  the  principle  underlying  the  use  of  high-frequency 
controls  for  trajectory  tracking  for  drift-free  nonholonomic  systems:  increasing 
the  frequency  of  oscillatory  controls  which  excite  a  certain  Lie  bracket  of  the 
system  and  scaling  the  amplitudes  accordingly  reduces  the  perturbations  of  the 
resulting  motion  in  the  direction  of  Lie  brackets  of  a  different  order. 

Brockett  (Brockett,  1993)  presented  such  open-loop  approximate  tracking 
controls  for  the  nonholonomic  integrator  which  we  will  state  here  in  a  slightly 
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modified  version. 


Proposition  3.2.1  Let  x{t)  =  x2{t),  xz(t))T,  t  e  [0,T]  be  a  desired 

smooth  trajectory  for  the  system  (3.3)  and  assume  x(0)  =  x(0)  =  0.  Define 
a  sequence  of  controls 

u^ft)  =  X\(t)  —  y/u  sin(c<;£) 

u^\t)  =  x2(t)  +  \fum(t)  cos(wf)  (3.9) 

with  m(t )  =  2 x3(t)  —X\ (t)x2(t)  +  x2(t)xi(t)  and  denote  the  solution  of  (3.3)  with 
control  by  x ^ .  Then 

lim  x^\t)  =  x(t),  t  G  [0 ,T],  (3.10) 

LJ—tOO 

where  the  above  convergence  is  uniform  with  respect  to  t. 

The  proof  of  Proposition  3.2.1  is  based  on  integration  by  parts  and  an  appli¬ 
cation  of  the  Riemann-Lebesgue  Theorem  and  can  be  seen  as  a  special  case  of 
the  proof  for  Theorem  4.2.1  of  Chapter  4. 

We  call  the  periodic  functions  appearing  in  (3.9)  carrier  functions  since  the 
role  they  play  in  the  motion  generation  for  nonholonomic  systems  is  somewhat 
analogous  to  the  role  of  carrier  functions  in  tele-communications.  To  approxi¬ 
mately  track  a  continuous  trajectory  the  carrier  functions  have  to  be  modulated 
in  order  to  specify  the  continuously  varying  velocity  of  the  motion  along  the 
corresponding  bracket  direction.  The  nonholonomic  system  itself  then  acts  as 
a  de-modulator.  In  (3.9)  amplitude  modulation  is  used,  but  as  will  be  shown 
below  other  types  of  modulations  are  possible. 

To  take  the  analogy  with  communications  a  little  further,  the  problem  of 
tracking  a  n-dimensional  nonholonomic  system  with  only  m  <  n  controls  can 
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be  compared  with  the  problem  of  transmitting  n  signals  over  only  m  <  n  chan¬ 
nels.  Control  laws  of  the  type  (3.9)  can  therefore  be  interpreted  as  frequency 
multiplexers  since  they  distribute  the  motion  information  pertaining  to  different 
brackets  of  the  system  into  distinct  frequency  bands.  The  nonholonomic  system 
with  m  inputs  (controls)  and  n  >  m  outputs  (states)  then  plays  the  role  of  a 
de-multiplexer. 

Approximate  tracking  controls  are  not  unique  since  they  are  only  required  to 
satisfy  a  convergence  condition.  In  the  following  we  will  discuss  some  possible 
variations. 

The  choice  of  sinusoidal  carriers  is  motivated  by  their  explicitness  and  smooth¬ 
ness,  as  well  as  by  the  fact  that  the  circular  trajectories  in  the  (aq,  aq^plane 
resulting  from  sinusoidal  carriers  are  extremals  of  a  specific  optimal  tracking 
problem  for  (3.3)  (see  Section  3.3).  Nevertheless,  in  the  general  case  the  controls 
(3.9)  do  not  satisfy  the  necessary  conditions  for  the  standard  optimal  track¬ 
ing  problem.  Other  types  of  carriers  might  be  used  alternatively,  for  instance 
switching-type  controls,  depending  on  the  properties  of  the  available  actuators. 

In  equation  (3.9)  the  term  specifying  the  velocity  for  aq  is  incorporated  as  an 
amplitude  modulation  of  the  sinusoidal  carrier.  It  is  also  possible  to  use  frequency 
modulation  of  the  carrier  for  the  generation  of  the  motion  in  the  direction  of  the 
first  order  Lie  bracket  as  demonstrated  in  the  following  proposition. 

Proposition  3.2.2  Let  x(t )  =  (aq(£),  aq(t),  aq(f))T,  t  e  [0 ,  T]  be  a  desired 
smooth  trajectory  for  the  system  (3.3)  and  assume  x(0)  =  x(0)  =  0.  Define 
a  sequence  of  controls 

u{“\t)  =  aq  (t)  —  y/urhf(t)sm(ujmf(t)) 

u?\t)  =  X2(t)  +  y/uj rhf(t)  cos(lu  mf(t))  (3.11) 
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with  rrif(t )  =  x3(t)  —  f*  xi(t)x2(t)  +  X2(t)xi(t)cIt  and  denote  the  solution  of 
(3.3)  with  control  by  x^\  Then 

lim  x^\t)  =  x(t),  t  G  [0,T],  (3-12) 

LJ—>  OO 

where  the  above  convergence  is  uniform  with  respect  to  t. 

Proof:  Integrating  x\  and  X2  of  (3.3)  with  controls  (3.11)  yields 

xi(t)  =  xi(t)  +  a;-5  (cos(o;m/(t))  —  1) 

X2 (t)  =  X2(t)  +  sin(u!mf(t)), 

and  it  follows  immediately  that  for  oj  —>  00,  X\  and  X2  converge  uniformly  on 
[0,  T]  to  Xi  and  x2  respectively.  For  x3  we  obtain 


x3  (t)  = 


-J  (t)+uj  2  (cos(o;r?7,/(r))  —  1)^  ^i2(r)  +  \fujrnf{r)  cos(wm/(T))^ 

—  ^x2(r)  +  a;_2  Sin(a;m/(T))^  ^Xi(r)  —  y^cum^r)  sin(u;mj(r))j(ir 

1  ft  (  1 

-  j  |xi(r)S2(r)  +  s/ujxi(T)mf(T)  cos(a;m/(r))  +  a;_2^2(r)(Cos(a;m/(r))  -  1) 
+m/ (t)  ( cos2(a;m/(r))  +  sin2 (a»m/(r)))  — rh/(r) (cos (umf(r)) 


-x2(t)xi(t)  +  x2(r)m/(r)sm(c<;m/(r))  +  Xi(r)m/(r)  sin(a;m/(r))  [dr 


= 


a;  xi(r)m/(r)  cos(a ;m/(r)) 


+cn_2a;2(r)(cos(a;m/(r))  —  1)  —  rh/(r)(cos(a;m/(r)) 

+\/w x2(r)m/(r)sm(c<;m/(r))  +  y^u; Xi(r)ihf(r)  sin(wm/(r))|dr 
=  x3(t)  +  o(w-^) 


where  the  last  equality  follows  from  an  application  of  the  Riemann-Lebesgue 
Theorem  (see  proof  of  Theorem  4.2.1).  Thus  also  .x'3  converges  uniformly  on 
[0,  T]  to  x3  for  u  — >  00. 
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□ 

Frequency  modulation  type  controls  are  of  advantage  if  for  fixed  u  the  error 
in  the  (aq,  x2)-plane  is  required  not  to  exceed  a  certain  limit  independently  of 
m(t). 

Completing  the  analogy  with  modulation  techniques,  also  phase-shift  type 
controls  are  possible  for  trajectory  tracking.  With  such  a  technique  the  phase 
angle  between  the  carrier  functions  is  varied  between  [— f ,  f]  depending  on  m(t ) 
while  keeping  the  frequency  and  amplitude  of  the  carrier  functions  fixed.  Even 
though  phase-shift  controls  allow  only  a  limited  range  of  motions  to  be  tracked, 
such  controls  would  be  of  advantage  if  by  the  nature  of  the  actuators  a  limited 
range  phase  shift  of  a q,  i  =  1,2  is  easier  to  achieve  than  a  variation  of  the 
frequency  or  amplitude  of  the  loops  in  the  (aq,  x2)-plane. 

Certain  specific  techniques  and  results  with  respect  to  asymptotic  stabiliza¬ 
tion  and  tracking  for  higher- dimensional  systems  presented  below  are  not  com¬ 
patible  with  frequency-  and  phase-modulation  type  controls.  We  will  therefore 
for  the  remainder  of  the  thesis  focus  on  amplitude  modulation  type  controls. 


3.3  Optimality 

In  this  section  we  will  explore  optimality  issues  for  tracking  control  of  drift- 
free  nonholonomic  systems  using  the  example  of  the  nonholonomic  integrator. 
We  will  see  that  the  inclusion  of  tracking  performance  in  the  objective  function 
leads  for  some  prescribed  trajectories  of  the  nonholonomic  integrator  to  tractable 
necessary  conditions  for  extremal  functions.  We  will  compare  these  necessary 
conditions  to  the  explicit  controls  of  type  (3.9). 
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Significant  progress  in  characterizing  optimal  controls  has  been  made  for 
the  point-to-point  optimal  control  problem,  i.e  steering  a  system  from  a  given 
initial  position  at  time  T0  to  a  desired  final  position  at  time  Tj  while  mini¬ 
mizing  an  objective  function  J  =  Y^iLi  Ui(t)2dt.  For  a  drift-free  system 
x  =  Er=i  fii  x)ui ,  x  G  Rn  it  is  well  known  (see  for  instance  (Walsh  et  al., 
1994))  that  the  norm  ||w(t)||  of  input  functions  satisfying  the  necessary  condi¬ 
tions  for  the  point-to-point  optimal  control  problem  is  a  constant  of  motion. 
Also,  for  invariant  system  on  three-dimensional  matrix  Lie  groups  it  has  been 
shown  by  Poisson  reduction  in  (Krishnaprasad,  1993)  that  the  differential  equa¬ 
tions  characterizing  extremal  controls  of  the  corresponding  Maximum  Principle 
are  integrable. 

But  even  though  the  form  of  optimizing  controls  may  be  available  explicitly, 
their  parameters  have  to  be  determined  numerically  in  most  cases.  Thus,  even 
for  the  simpler  point-to-point  problem,  optimizing  controls  can  in  most  cases  not 
be  used  to  directly  formulate  explicit,  open-loop  control  laws. 

In  the  context  of  open-loop,  approximate  tracking  we  are  not  only  interested 
in  optimizing  the  control  effort  but  in  simultaneously  minimizing  the  deviations 
from  the  desired  trajectories.  To  keep  the  problem  tractable  we  focus  on  the 
nonholonomic  integrator  and  incorporate  the  deviations  of  x%  from  Xi  for  i  —  1,  2 
in  the  objective  function,  i.e.  the  goal  is  to  find  tq(-),  i  =  1,2  which 

minimize  ^  J  ~Xi(t))2  +  (x2(t)  -  x2(t))2  j  +  Ui(f)2  +  u2(t)2dt  (3.13) 

subject  to 

Xi  =  U\ 

x2  =  u2  (3-14) 
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X-i  =  ~{xiU2  -  X2Ui), 
for  given  boundary  conditions 


xi(0)  =  xio,  x2(0)  =  x20,  x3(0)  =  x30 

X\ (1)  =  Xif,  x2(l)  =  x2f,  £3(1)  =  x3f.  (3.15) 


Proposition  3.3.1  Given  desired  trajectories  xfi-),  i  =  1,2  assume  that  x*(-)  = 
(x*(-),  x^-),  xl(-))T  is  an  optimal  trajectory  for  the  optimal  control  problem  de¬ 
fined  by  (3.13),  (S.lj),  (3.15).  Then  there  exists  a  A  G  M  such  that  x*(>),  x^fi), 

ul(')  =  £*(')>  and  u2(')  =  >^2 (’)  satisfy 


G.) 

0 

0 

0 

M 

0 1 

X2 

0  0  0  1 

X2 

0 

= 

-  T 

Ul 

p  0  0  —A 

Ul 

X\ 

[u2  ) 

^  0  p  A  0  j 

U2/ 

U2  / 

Proof: 

With  the  Lagrangian 


(3.16) 


xfit))2  +  (x2(t) 


x2  (t))2)  +  ufit)2  +  u2(t)2} 


and  the  adjoint  state  p  =  ( Pi,P2,P3)t  dehne  the  Hamiltonian 


H(x,p,u )  =  p0L(x,u)  +pTf(x,u) 

=  -L(x,  u )  +  P1M1  +  p2u2  +  ~ prefix iU2  -  X2rti), 

where  we  have  assumed  without  loss  of  generality  p0  =  —  1  since  we  only  consider 

regular  extremals  here.  Given  an  optimal  trajectory  x(-)  there  exists  according  to 

Pontryagin’s  Maximum  Principle  a  function  p(j  satisfying  the  adjoint  equations 

dH(x,p,u) 

P  = - ^ 
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such  that  the  optimal  controls  are  characterized  by 


dH(x,p,  u ) 
dui 


0, 


i  =  1,2. 


(3.17) 


Writing  out  the  adjoint  equations  we  obtain 

Pi  =  -  Xi) 

P2  =  ^P3«l  +  p(x2  ~  X2)  (3.18) 

P3  =  0 

and  note  that  Pz{t)  =  p30,  where  we  are  free  to  choose  p^  since  we  assumed  hxed 
initial  and  final  conditions  on  x 3.  It  follows  from  (3.17)  that 


1 

ui  =  --P30X2+P1 

1 

«2  =  -jP30xl  +  P2, 


which  yields  after  differentiating  with  respect  to  time 

1 

Ml  =  -^P30x2+Pl 

=  -P30U2  +  n{xi  -  xi) 

1 

«2  =  -P30^1  +  P2 

=  p3ui  +  p(x2  -  X2). 


Thus,  setting  A  =  p30  we  have  proven  the  result. 

□ 

Note,  that  since  (3.16)  is  a  linear  time-invariant  differential  equation  we  can 
explicitly  obtain  the  form  of  controls  satisfying  the  Maximum  Principle  for  ar¬ 
bitrary  xi  and  x2. 

It  turns  out  that  the  sinusoidal  carrier  functions  of  (3.9)  satisfy  the  necessary 
conditions  of  the  optimal  control  problem  (3.13),  (3.14),  (3.15)  only  in  a  very 
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special  case,  namely  if  x\  =  £2  =  0  and  £i(0),  £i(l),  £2(0),  £2(1)  are  assumed  to 
be  free.  Then  it  can  be  verified  that  the  trajectories 


x\ (t)  =  mcos(o;t); 
x2(t)  =  rasin(u;£); 


Ui(t )  =  — men  sin(c<;t) 

Ui(t)  =  mu;  cos(cot) 


(3.19) 


with  m  G  R  and  w6l  satisfy  (3.16)  with  A  —  u  +  -.  To  achieve  Ax3  =  £3/  —  £30 
we  have  to  have  m  =  in  (3.19)  2.  To  obtain  the  optimal  frequency  we 

then  plug  (3.19)  in  to  the  objective  function  J  and  differentiate  to  obtain 

dJ  _  A.£3  /  n  \ 

diu  ~  2  V  cv2  )  ' 

It  follows  that  the  optimal  frequency  =  y7//  is  independent  of  A£3.  Thus  the 
controls  (3.9)  (using  amplitude  modulation)  are  preferable  to  the  controls  (3.11) 
(using  frequency  modulation)  in  this  case  and  given  £i(0)  =  v/‘^X3  ,£2(0)  =  0 
indeed  satisfy  the  Maximum  Principle  for  the  above  optimal  control  problem. 

The  dependency  of  the  optimal  frequency  on  /1  characterizes  the  trade-off 
between  control  effort  and  tracking  accuracy  under  the  above  assumptions  but 
might  also  be  used  as  a  suggestion  of  how  to  adjust  the  frequency  parameter  in 
the  general  case. 


2It  then  follows  from  (3.19)  that  X3 (t)  =  AX3  *t  and  that  the  above  controls  also  satisfy  an 
optimal  control  problem  which  includes  a  trajectory  error  term  (X3  —  Aa;3  *  t)2  in  (3.13)  with 
otherwise  unchanged  assumptions. 
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Chapter  4 


Approximate  Inversion  of  Nilpotent 
Systems 


The  focus  of  this  chapter  will  be  the  definition,  significance  and  control  of  nilpo¬ 
tent  systems.  We  call  an  invariant  system  on  a  matrix  Lie  group  G  a  nilpotent 
system  if  G  or  equivalently  the  Lie  corresponding  Lie  algebra  g  is  nilpotent. 
Nilpotent  systems  play  a  special  role  in  control  of  nonholonomic  systems  since 
their  Lie  algebra  structure  leads  to  significant  simplifications  in  their  treatment. 
On  the  other  hand  nilpotent  systems  have  been  shown  to  be  locally  feedback 
equivalent,  for  instance,  to  the  kinematics  of  wheeled  robots,  which  play  an  im¬ 
portant  role  in  robotic  applications  and  have  been  a  major  motivation  for  the 
study  of  drift-free  nonholonomic  systems. 

Looking  at  the  Fomenko  Chakon  expansion  (2.13)  for  the  solution  of  a  nilpo¬ 
tent  system  in  the  coordinates  of  the  first  kind  the  advantages  of  g  being  nilpo¬ 
tent,  say  of  order  k,  become  immediately  apparent.  Since  the  series  expansion 
terminates  after  the  term  Zk,  (i)  one  does  not  need  to  worry  about  components 
of  the  trajectories  coming  from  higher  order  Lie  brackets  and  (ii)  the  system  can 
be  integrated  by  a  finite  series  of  quadratures. 
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Restricting  the  input  to  a  linear  combination  of  explicitly  integrable  func¬ 
tions,  property  (ii)  implies  that  forward  integration  of  the  nilpotent  system  can 
be  replaced  by  a  fixed  map  from  the  coefficients  of  the  input  function  to  a  set 
of  coefficients  parameterizing  an  explicit  given  output  function.  This  allows  us 
to  reduce  the  point-to-point  problem  to  the  inversion  of  a  polynomial  map  and 
to  cast  the  problem  of  optimal  tracking  control  as  a  finite  dimensional  static 
optimization  problem. 

In  our  context  of  open-loop  tracking  property  (ii)  will  allow  us  to  construct 
simple  control  laws  and  prove  the  corresponding  convergence  result  for  open-loop 
tracking  by  means  of  elementary  mathematical  tools. 

In  Section  4.1  we  show  how  equivalent  forms  of  nilpotent  systems  extensively 
studied  in  research  on  nonholonomic  path  planning  do  in  fact  arise  as  local 
representations  of  invariant  systems  on  a  single  nilpotent  matrix  group.  The 
main  result  of  this  chapter  concerning  approximate  inversion  of  chained-form 
systems  is  proven  in  Section  4.2. 

4.1  Local  Representations  of  Nilpotent  Systems 
on  Matrix  Lie  Groups 

Recall  that  a  p  x  p-matrix  A  is  called  nilpotent  if  Ak  =  0  for  some  integer  k 
and  the  smallest  such  k  is  called  the  index  of  nilpotency.  Nilpotent  matrices 
are  of  interest  also  in  linear  systems  theory  as  a  matrix  in  Jordan  form  can  be 
decomposed  into  a  diagonal  matrix  and  a  nilpotent  matrix. 

A  p  x  p-matrix  X  =  ( )  satisfying  Xu  =  1,  i  =  1, ...  ,p  and  Xij  =  0 
whenever  i  >  j,  i.e.  a  upper  triangular  matrix  with  ones  on  the  diagonal,  is 
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called  unipotent.  The  unipotent  matrices  UP{n)  form  a  Lie  group  with  the  Lie 
algebra  up(n)  consisting  of  matrices  A  =  (A?)  satisfying  Aj  =  0,  whenever 
i  <  j.  It  can  be  verified  that  the  elements  of  the  Lie  algebra  of  p  x  p  unipotent 
matrices  are  nilpotent  with  index  k  and  moreover  that  the  Lie  algebra  itself  is 
nilpotent  of  order  k  ,  where  k  <  p. 

Consider  a  n-dimensional  subgroup  G  of  the  unipotent  matrices  consisting 
of  elements  X  of  the  form 


f  1 

x2 

Xi 

x5 

0 

1 

Xi 

1t2 

2X1 

1^3 

6X1 

1 

Xi 

1t2 

2X1 

X  = 

1 

Xi 

1 


Xr 


\ 


-2V.X1 


,71— 2 


(n— 2)! 


1^3 

1^2 

2X1 


x  =  (x1,...,xn)T  e 


I  X1 

\  o  •••  0  1  ) 

(4.1) 

which  we  call  SUP{n )  for  future  reference.  1  Note,  that  for  n  =  3  SUP(n )  is 
isomorphic  to  the  real  Heisenberg  group  H( 3). 

Fix  the  following  basis  for  the  Lie  algebra  of  SUP(n )  : 


^00  0  ■■■  0  ^ 
oo  i  '  - .  : 


1  0  1  0  ■■■  0  ^ 
0  •••  0 


Ai  — 


\ 


0 


0  , 
1 

°J 


A2  — 


V 


0 


(4.2) 


are  not  aware  of  a  standard  nomenclature  for  the  above  matrix  Lie  group. 
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This  choice  of  a  basis  results  in  the  following  non-zero  Lie  brackets 

adAlA2  =  -A3 i 

ad2AlA2  =  A4  (4.3) 

adnA~2A2  =  (-1  )n~2An, 

while  all  other  Lie  brackets  vanish.  Thus,  SUP(n )  is  nilpotent  of  order  n  —  2. 

We  start  by  considering  the  following  two-inpnt,  drift-free,  fe/t-invariant  sys¬ 
tem  on  SUP(n ) 

X  =  X{UlA l!  +  u2A2),  X  e  SUP{n )  (4.4) 

with  Ai,  A2  as  dehned  above.  It  follows  from  (4.3)  and  Theorem  2.3.2  that  (4.4) 
is  controllable,  more  specifically,  that  (4.4)  is  a  depth- (n  —  2)  system. 

The  entries  Xi, . . . ,  xn  of  X  e  SUP(n )  as  described  in  (4.1)  provide  us  nat¬ 
urally  with  global  coordinates  for  SUP{n).  Thus,  by  equating  the  entries  on 
either  side  of  equation  (4.4)  we  obtain  the  following  globally  valid  representation 
of  (4.4)  on  Rn: 

Xi  =  Ui 

x2  =  u2 
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X2U  1 


(4.5) 


£3  = 

x4  =  X3U1 

i'n  Xfi—iU±. 

Note  that  x±, ...  ,xn  coincide  with  the  canonical  coordinates  of  the  second  kind 
for  SUP {n)  and  that  (4.5)  therefore  represents  the  product  of  exponentials  rep¬ 
resentation  of  (4.4).  We  say  that  system  (4.5)  is  in  chained  form.  Due  to  its 
lower  triangular  structure  we  can  integrate  (4.5)  by  quadratures  and  the  solution 
for  the  ith,  i  =  3, . . . ,  n  state  can  be  written  as 

ft  fT\  fTi-3  fTi- 2 

Xi(t)  =  /  ui(ti)  /  Ui(r2)...  /  ui(Ti-2)  /  u2(Ti-1)dTi-i  ■  ■  -dn, 

Jo  Jo  Jo  Jo 

assuming  x(0)  =  0. 

Next  consider  the  right- invariant  version 

Y  =  (uxAx  +  u2A2)Y,  X  e  SUP{n)  (4.6) 

of  system  (4.4).  Using  again  the  canonical  coordinates  yi,...,yn  of  the  second 
kind  for  SUP(n )  the  product  of  exponentials  representation  of  (4.6)  turns  out 
to  be 


ih  = 

V  2  =  u2 

y  3  =  yiu2  (4.7) 

1  2 

1U  =  2^2 


Vn 


(n-  2) 


■Vi  W 
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Systems  of  the  type  (4.7)  are  called  systems  in  power  form. 
Rewriting  (4.4)  and  (4.5)  as 


X  =  X{-uxAx  +  -u2A2),  X  e  SUP{n ) 


(4.8) 


with 


/ 


X  = 


1  —x2  x3  —x4  x5 

0  1  —xi 

1  —Xi 

1  —X\ 

:  1 


1™2  _1„3 

2  x  1  6  J  1 


1-2 

2X1 


\ 


;-iy 


4-2  1  „w- 2 

(n-2)!Xl 


_ix3 

6X1 

I~2 

2X1 


-Xi 

1 


we  see  from  the  relationship  (2.10)  between  left-invariant  and  right  invariant  sys¬ 
tems  on  matrix  Lie  groups  that  if  X  is  a  solution  of  (4.8)  then  X _1  satishes  (4.6). 
The  coordinate  transformation  T  mapping  the  coordinates  of  the  chained  form 
system  to  the  coordinates  of  the  power  form  system  can  therefore  be  obtained 
by  Y  =  T{X)  =  (X)”1  and  component-wise  we  have 


Vi  =  xi 
yi  =  x2 
2/3  =  -Xi  +  XiX2 

1 

y4  =  x4  -  x4x3  +  -xxx2 

n— 1  ^ 

Vn  =  (-1K  + 


(4.9) 


(4.10) 
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In  the  case  n  =  3  the  group  SUP(n )  coincides  with  the  Heisenberg  group  H( 3) 
and  the  single  exponential  representation  of  (4.6)  yields  Brockett’s  nonholonomic 
integrator. 

A  generalization  of  the  Lie  algebra  structure  (4.3)  to  systems  with  rn  +  1 
inputs  leads  to  so  called  (m  +  l)-input,  (m)-chain,  single  generator  chained  form 
systems  which  are  described  in  the  following  section. 

Chained  and  power  forms  system  play  an  important  role  in  the  study  of  the 
kinematics  of  various  types  of  wheeled  robots.  Kinematic  models  of  a  simplified 
unicycle,  a  car,  or  a  tractor  with  trailers,  for  instance,  have  a  Lie  algebra  struc¬ 
ture  compatible  with  the  Lie  algebra  structure  of  chained  form  systems  and  can 
be  locally  converted  via  a  feedback  and  coordinate  transformation  into  chained 
form.  Control  issues  such  as  open-loop  point-to-point  steering,  as  well  as  point 
and  trajectory  stabilization  for  chained  form  systems  were  studied  for  instance 
in  (Murray  &  Sastry,  1993;  Samson,  1995). 

While  chained  form  systems  reflect  more  directly  how  motion  is  propagated 
in  the  kinematic  description  of  a  tractor  and  trailer  system,  power  form  systems 
resolve  this  recursive  dependency  and  describe  a  state  yi,i  >  3  solely  in  terms 
of  yi  and  u2 •  This  property  makes  the  power  form  description  especially  suited 
for  the  derivation  and  proof  of  stabilization  results. 

4.2  Approximate  inversion  of  Chained-Form  Sys¬ 
tems 

In  this  section  we  will  present  open-loop  tracking  controls  or,  in  the  termi¬ 
nology  established  in  Chapter  3,  an  approximate  inverse  for  (n)-dimensional 
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chained  form  systems  extending  the  result  of  Brockett  (Brockett,  1993)  for  a 
three-dimensional  system.  To  create  independent  motions  in  the  direction  of  the 
l  —  n  —  2  higher  order  Lie  brackets  required  for  controllability  we  can  make  use 
of  the  particularly  simple  Lie  algebra  structure  of  (4.5). 

As  opposed  to  the  general  method  of  Liu  and  Sussmann  (Sussmann  &  Liu, 
1991)  which  requires  l  sets  of  so-called  mutually  independent  minimally  can¬ 
celling  frequencies  the  following  results  use  only  one  set  of  l  integrally  related 
frequencies. 

This  is  achieved  by  specifying  the  desired  velocity  terms  for  the  states  ay,  i  — 
3, . . . ,  n  in  «2  as  amplitude  modulations  of  integrally  related  sinusoids.  The  co¬ 
sine  term  in  uf  shifts  the  frequency  components  by  the  successive  multiplications 
in  the  chain  of  (4.5)  such  that  for  each  state  ay,  i  —  3, . . .  ,n  the  velocity  term 
corresponding  to  ay  is  in  resonance  with  the  cosine  term. 

Theorem  4.2.1  Given  a  n-dimensional  chained-form  system  (4-5),  let  x{t )  = 
(ay(t), x2(t),  ...,xn(t))T,  t  G  [0, T]  denote  the  desired  trajectory.  Assume  that 
x  is  twice  differentiable  on  [0, T]  and  that  x(0)  =  a;(0)  =  x(0)  =  0.  Define  a 
sequence  of  controls 

=  xAt)  +  2  cos(wf) 

(4.H) 

=  f2{t)  +  Ylm= 1  am(t)  fnL  JL(cos  (mut)),  l  =  n-  2 

Oimit)  =  icm+2(t )  -  {t)xm+1  (t) . 

Let  x^(t),  0  <t<T  be  the  solution  of  (4-5)  with  as  input.  Then 

lim  x^\t)  =  x(t),  Vt  G  [0,  T]  (4.12) 

u— >-oo 

where  the  convergence  is  uniform  with  respect  to  t. 


u\ 

A) 

«2 


where 
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Proof:  We  start  by  proving  a  lemma  which  enables  us  to  discard  terms  in  the 

solution  of  (4.5)  which  vanish  in  the  high-frequency  limit. 


Lemma  4.2.2  Let  f  be  of  bounded  variation  on  [ a,b ]  and  let  (j)  e  [0,  27t]  .  Then 
as  uj  — *  oo 

[  f(t)cos(ut  +  (j))dt  =  o(l/u).  (4-13) 

J  a 

Proof:  (Lemma  4.2.2  )  By  the  Jordan  Decomposition  Theorem  we  can  write  a 

function  /  of  bounded  variation  as  the  difference  of  two  non-decreasing  functions, 
and  therefore  it  suffices  to  show  the  lemma  for  non- decreasing  functions. 

Now,  assuming  /  to  be  non-negative  and  non- decreasing  and  g  continuous, 
it  follows  from  a  Bonnet  form  of  the  Second  Mean  Value  Theorem  that  there 
exists  a  £  G  [a,  b]  such  that 

[  f(t)g(t)dt  =  f(b)  [  g(t)dt. 

Ja  Je, 

Hence,  there  exists  a  £  G  [a,  b]  such  that 

pb  pb 

|  /  f(t)  cos(ut  +  <f>)dt\  =  |  f(b)  /  cos(wf  +  (f>)dt\ 

Ja 

2  fib) 


< 


UJ 


and  (4.13)  follows  from  the  boundedness  of  /  on  [a,  b\. 


□ 


Note  that  we  can  readily  apply  Lemma  4.2.2  in  our  context  since  the  smooth¬ 
ness  assumption  on  x  implies  that  the  xt ,  i  =  1,2,...,  n  are  of  bounded  variation. 

We  proceed  to  show  convergence  xf\t)  — »  Xi(t),  1  <  i  <  n  for  uj  — *  oo  , 
which  implies  the  convergence  x^°\t)  —>  x{t)  with  respect  to  the  standard  norm 
on  Rn .  Writing  out  the  solution  for  the  first  state 

x\ \°\t)  =  Xi(0)  +  f  u[w)(r)dr 

J  o 
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X\ (r)  +  2w'+‘  cos (oor)dr 


it  follows  that 


=  aq(£)  +  2u;  '+1  sin(t<;f), 


lim  x{\t)  =  X\  (£),  Vf  G  [0,  T], 

CJ— >-00 


(4.14) 


where  the  convergence  is  uniform  with  respect  to  t. 

Using  integration  by  parts  we  have  for  the  second  state 

rt 


x2  (t)  =  ^2(0)  +  J  u(2  \r)d- 

pt  1 


■T 


' 0 


-  \  /  \  —2nL  nr!  dm  .  .  .. 

x2{r)  +  2^  am{r)  u  ^  —  -^{cos{mwT))dT 


m=  1 


l 


=  x2{t)  +  y^jam{t) 

m=  1 
^  r>t 

-22  /  “™Ww' 


mm  dr m 


™l  m!  dm  1  .  .  .. 

u  i+1 - -  —  (cosymut)) 


mm  dtm- 


.  mi  m!  dm  1 


i+i 


—  (cos  (mint)), 


ra=l  ' 


mm  dtm~ 

_ 1_  _  _ f  1-1 _ ) 

where  the  first  sum  is  of  order  u>  '+1  and  the  second  sum  is  of  order  uo  y  *+*' 

by  Lemma  4.2.2.  Thus 


lim  x\ ?\t)  =  x2 (t),  Vf  G  [0, T], 


(4,15) 


where  the  convergence  is  uniform  with  respect  to  t. 

In  writing  down  the  solution  for  the  third  state  it  will  become  clear  how  the 
successive  multiplications  with  u\  and  subsequent  integrations  required  to  solve 
(4.5)  affect  the  limit  behavior  of  the  involved  terms.  Plugging  in  for  «i(r),  using 
the  identities 

1 


cos(caf)  cos(nwf)  =  2  (  cos((n  —  1  )wt)  +  cos((n  +  l)wf)^  ,  (4.16) 


2cos(wf)  22 


m\  dm  1  (m  —  1)!  dm  1  / 

—  (cos (mwr))  =  2^  (m  _  i)m-i  {  cos((m-l)a;r)+COs((m+l)a;r 


mm  dr™ 
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and  integrating  by  parts  we  obtain: 


4 ;  (*) 

=  ®3(0)+  f  u^\r)xt\r)dr 


I  (^i(r)  +  2un+i  cos(cnr))  (x2(r)  +  am(r)  u  '+1  A——(cos (mT)) 

■'°  m=l  m  T 

+o(o+<1+i+t)  )  j  dr 


x\{r)  x2(t)  +  xi(r)ai(r)  a;  '+1  cos(wt) 


+2w1+ix2(r)  cos(a;r)  +  cti(r)  +  ai(r)  cos(2u;r) 


mi  m!  dm  1 

a;  ;+J - - - -(cosimcnr)) 


\  ^  ^  /  \  rnl  ^Yl-  CL 

+  (z1(t)  +  2c++icos(u;t)J  !+1  ^ 

m=2 

+o(w_(1+t+t))  j  jdr 


r)  +  xi(r)ai(r)  a;  '+1  cos(a;r)  +  2w!+1x2(r)  cos(a;r)  +  a?i(r)  cos(2a;r) 


,  v  (771—  1)!  d171  1  /  //  i\  \  //  i\  w 

+  2^  a™(T)  ^  '+1  (m  _  !)m-l  ^l(C°S((m  -  ^  +  COS((m  +  1 VT)) 


+2w'+i  cos(a;r)o(a;  (1+i+l)) 


/  ^  ,  ^1  ,Jm— 1  .. 

+^i(r)  (  S  a™(r)  ^tt(cos(tou;t))  +  o(^_(1+7Tt))) 

m—  1 

=  x3(t)  +  2u+7+T  x2(t)  sin(a;t) 

/\  — rai.  (nr— 1)!  dm~2  ,  ..  .  .  ..  .  .. 

+  2^  amW  w  '+1  _  p— I  ^=^(cos((to  -  !)^)  +  cos((™  +  !)^)) 

m=2  '  ' 

ft  f  •  /  \  — -™L  (TO  —  1) !  dm  2  .  .  .  .  ,  , 

-  Jq  {l^am{r)u  i+1  (m  _  1)m_1  ^n(cos((TO  -  l)a>r)  +  cos((to  +  l)ur))jdr 


+o{uo  ) 

=  x3(t)  +  o(w_T+i). 


Again  as  a  consequence  of  Lemma  4.2.2  all  terms  in  the  expression  for  x3(t) 
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except  for  x% (f)  are  of  negative  order  with  respect  to  uj  and  therefore 


lim  x^\t)  =  x3(t),  Vf  G  [0,T],  (4-17) 

UJ— too 


where  convergence  is  again  uniform  with  respect  to  t. 

To  establish  an  induction  argument  assume  for  the  states  x3 ,  j  =  4,  ...,n 
recall  that  for  i  =  1, . . . ,  n  —  2 

pt  m  pi-i  rn 

xi+2(t)  =  /  Wi(ri)  /  Ui(r2)...  /  Ui(7i)  /  ii2(7i+i)dTi+i  •  •  -dTi,  (4.18) 

do  do  do  do 

i.e.  xi+2  is  obtained  by  applying  an  iteration  to  u2  consisting  of  integration 
and  multiplication  with  u\.  According  to  (4.16)  the  terms  of  u2  are  iteratively 

l 

frequency-shifted  by  ±o;  for  each  multiplication  with  the  2w‘+1  cos (ut) -terms  of 
U\.  We  write 


x 


(u) 
i+ 2 


(!)  = 


Xi+ 2  +  "^2  { am(t ) 


uj  !+1 


( m  —  % ) 


d 


'm— i+l 


m=i+l 
l 


(m  -  i)m~* 


+2  a;  xi+i(t)  sin  (cut)  +  pi+2  +  o(u  x), 


(cos((m  —  i)ut))} 
(4.19) 


where  the  summation  in  (4.19)  is  comprised  of  the  terms  whose  frequencies  have 

l 

been  shifted  by  —uj  for  all  previous  multiplications  with  2uil+1  cos  (cot).  The  terms 
whose  frequencies  have  been  shifted  at  least  once  by  -\-uj  due  to  multiplication 

l 

with  2w'+1  cos  (ut)  are  subsumed  under  pi+2.  The  terms  in  pi+2  are  of  lower  order 
in  uj  as  compared  to  terms  in  the  summation  with  the  same  frequency.  It  can  be 
verified  that  therefore  the  contributions  of  pi+2  to  the  states  Xj,j  —  i  +  3, . . . ,  n 
vanish  in  the  high-frequency  limit.  We  assume  further  that  pi+2  =  o(o;7+T)  such 
that  limw_J.0O  x^}2 (t )  =  xi+2(t),  Vf  G  [0,T].  Note  that  x3(t)  is  of  the  form  (4.19). 
The  following  state  can  be  written  as 


x 


{uj) 

i- K3 


(t) 
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Ul{T)xi+2{T)dT 

x\(r)  +  2wi+T  cos (wt)|  ^a;j+2(r)  +  Xj+i(r)  sin+r) 

-(m-i)i  (m  — *)!  cP1-*"1"1 

+  2^  “m(T)W  '+1  ^  _  „-Vn-i  ^m-»+l  (COS((m  -  'l)UJT>)  +Pi+ 2  +  °+  )Mr 


(m  -  drm~i+1 
jxi (r)®i+2(r)  +xi(r)(xj+2(r)  -xi+2(r)) 


772=2+1 
rt 


+2oJl+1Xi+2{T)  cos(u;t)  +2o;i+1^+i(r)sm(o;r)  +  o:*+i(t)  +  a*+i(r)  cos(2c<;t) 

^  ^  —  (m— i— 1)Z  (rn  —  7  —  1  V  J777,  2+1 

+  am(r)  u  m  — - ,  - XTr,_._i  (cos((m  -  i  -  1)ojt)  +  cos((m  -  i  +  l+r)) 


772=2+2 
l 


(m-i-  l)™-*-1  drm~i+l 


+20;'+!  cos(L0T)(pi+2  +  o(u  ))  jdr 
-1  _ 

=  xi+3(t)  +2ul+1  Xi+2 (r )  sin(a;r ) 

-(m-i-l)l  (jyi  —  £  —  1)1  dm~^ 

+  Y  a™^>u  ,+1  ^  _  nm-i-1  (c°s((m  -  i  -  l)wt)  +  cos((m  -  i  +  l)wt) 

772=2+2  ' 

rt 


+  {®i (r)(*i+2(r) -xi+2(r)) 


r — .  —  (m— i— 1)Z  (rr)  —  7"  —  1  /7m  * 

-  Y  1+1  (cos((m-z-l+r)  +  cos((m-i  +  l+r) 

m=i+2  V  ' 

+2o;7+T  cos(wr))(pj+2  +  o(u+))  jdr 

sr^  (m  —  i  —  1)!  dm~l  .  ..  .  .. 

=  ®i+3(*)  +  ^  «m(t)w  '+1  (cos((m-z-l+t)) 

772=7+2  '  ' 

-1  _ 

+2w!+1Xi+2(r)sin(a;r) +p*+3 +  o(w  ). 

Note  that  also  here  the  contributions  of  pi+ 3  and  the  o+_1)  to  x j ,  j  =  i  +  4,  n 
vanish  in  the  high-frequency  limit.  Again,  we  have 


lim  4ksW  = 


lim 

cj— >-00 


+  o(u  z+! 


=  xi+3(t),  vte[o,r] 


where  the  convergence  is  uniform  in  t.  Our  claim  follows  by  induction  on  i. 


□ 
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Theorem  4.2.1  can  be  straightforwardly  extended  to  so  called  ( m  +  l)-inpnt, 


m-chain,  single  generator  systems  of  the  form 


34,0 

=  u  1 

•Em,  0  ^ra 

*1,1 

=  Xifl  Ui 

%m,l  •Em, 0 

(4.20) 

•Em, rim  — 1 

whose  state  vector  x  =  (x0,  x^o, . . . ,  Xi;ni,  . . . ,  xmj0, . . . ,  £m,nm)  is  of  dimension 
1  +  These  systems  were  studied  in  (Bushnell  et  al,  1993)  where  it 

is  also  shown  that  the  kinematic  description  of  a  fire-trnck  is  locally  feedback 
equivalent  to  a  three-input,  two-chain,  single  generator  system. 


Corollary  4.2.3  Given  a  ( m+1) -input  chained-form  system  of  the  form  (f.20), 
let  x(t),  t  e  [0,  T]  denote  a  twice  differentiable  desired  trajectory  satisfying 
x(0)  =  x(0)  =  x(0)  =  0.  Define  a  sequence  of  controls 


u 


(a ;)  _  i. 


=  Xo(t)  +  2W-+1  cos  (a it) 


(4.21) 


(ai) 

u)  =  X. 


ni  •  j  (jj 

ho(t)  +  5^  -j  ^-(c°s(ju;f)),  i  =  1, . . . ,  m 


3= 1 


where 


v  =  max  n, 

=  &i,j+2{t)  -  5o(t)xijj+i(t). 

Let  x^\t),  0  <t<T  be  the  solution  of  (f. 5)  with  as  input.  Then 

lim  xH(f)  =  x(t),  Vt  e  [0,  T]  (4.22) 

LJ—>  OO 

where  the  convergence  is  uniform  with  respect  to  t. 
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Proof:  The  result  of  Corollary  4.2.3  follows  from  applying  the  proof  of  The¬ 

orem  4.2.1  to  each  of  the  m  chains  of  (4.20)  separately. 

□ 

The  following  series  of  remarks  concern  implementational  issues  of  the  above 
control  laws  and  a  discussion  of  the  resulting  error  terms. 


w0  =  10 


Figure  4.1:  Trajectory  tracking  for  three-dimensional  chained  form  system  with 
carrier  frequencies  u>  =  10  and  u)  =  50 


Remark  4.2.4  Since  the  convergence  in  Theorem  4.2.1  and  Corollary  4.2.3  is 
uniform  in  t,  also  the  tracking  error  defined  as  E  =  J QT  || x(r)  —  x^(r)||p  dr , 
with  ||  •  ||  a  Zp-norm  on  Rn,  goes  to  zero  with  u  — >  oo. 

Remark  4.2.5  The  trajectory  errors  x  —  x  in  Theorem  4.2.1  and  Corollary  4.2.3 
are  of  order  —  and  -  -C-_  jn  respectively.  Hence  the  convergence  properties 
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with  respect  to  the  frequency  parameter  to  worsen  with  the  maximal  depth  of 
the  Lie  brackets  required  for  controllability  of  the  system  at  hand.  This  type  of 
phenomenon,  namely  that  control  becomes  increasingly  difficult  from  a  practical 
point  of  view  with  increasing  depth  of  the  nonholonomic  system,  manifests  itself 
also  in  other  motion  control  problems  such  as  feedback  stabilization  (Gurvits  & 
Lie,  1992). 

Remark  4.2.6  We  have  assumed  x(0)  =  x(0)  =  x(0)  =  0  in  Theorem  4.2.1 
and  Corollary  4.2.3  so  that  we  can  discard  the  initial  conditions  and  evaluations 
of  the  lower  limit  of  any  definite  integral  in  the  proof.  Nevertheless,  the  above 
results  hold  whenever  x(0)  =  x(0)  and  x(0)  =  0.  The  control  laws  of  Theorem 
4.2.1  and  Corollary  4.2.3  share  the  drawbacks  common  to  all  open- loop  control 
laws:  an  error  for  the  initial  condition  x(0)  or  any  other  perturbation  of  the 
state  on  the  interval  [0,  T]  is  not  compensated  for.  In  fact,  since  the  chained 
form  systems  (4.5),  (4.20)  are  local  representations  of  an  invariant  system  on  a 
matrix  Lie  group  the  initial  error  x(0)  corresponding  to  X(0)  =  X0  G  G  causes 
an  error  x(t),  t  G  [0,  T]  corresponding  to  a  translation  of  the  desired  trajectory 
X  on  the  group  by  X0. 

Remark  4.2.7  The  control  law  in  Theorem  4.2.1  contains  several  degrees  of 
freedom  under  which  the  convergence  to  the  desired  trajectory  is  preserved.  For 
instance  other  shapes  of  the  carrier  functions  would  be  possible.  Sinusoids  are 
chosen  here  due  to  their  smoothness  and  since  they  facilitate  explicit  computa¬ 
tions.  Also,  the  amplitudes  of  the  oscillatory  terms  in  (4.11)  can  be  modified  in 
the  following  way 

u(i'  =  Xi  (t)  +  2  po>7+T  cos (ut) 
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^  I  7777, 

u(2  ]  =  X2(t)  +  Y  Pmam{t )  uT^  —(cos(mut)),  (4.23) 

m=l 

with  p  >  0,  allowing  to  adapt  the  amplitude  of  the  oscillatory  component  of  iif'1 
to  the  given  desired  trajectory. 

We  conclude  this  chapter  with  a  lemma  presenting  an  estimate  x(t )  for  the 
state  x[t )  of  the  chained  form  system  (4.5)  with  controls  (4.11)  with  x(t)  de¬ 
pending  explicitly  on  the  desired  trajectory  x  and  x.  This  estimate  will  be  used 
in  Chapter  5  for  converting  feedback  control  laws  into  open-loop  form.  Since  the 
estimate  becomes  rather  complex  with  increasing  dimension  n  we  do  not  present 
a  general,  explicit  form  of  the  estimate.  An  example  of  the  precise  form  of  x  for 
n  =  3  also  can  be  found  in  Chapter  5. 


Lemma  4.2.8  Consider  the  n-dimensional  chained-form  system  (4-5),  a  twice 
differentiable  desired  trajectory  x(t)  =  x2(t),  . . .  ,xn(t))T ,  t  e  [0,  T]  sat¬ 

isfying  x(0)  =  x(0)  =  ai(0)  =  0,  and  approximate  inversion  controls  of  the  form 
(4-11).  Let  otjifij  be  rationals  satisfying  aj,/3j  <  fj,gj  be  monomials  in 
the  components  of  x  and  x,  and  m,j,nj  be  positive  integers.  Then,  there  exist 
estimates 

Xi(t)  =  Xi{t)  +  ii(t,u,x,x)  (4.24) 

for  the  states  Xi(t),  i  =  1,2, ...  ,n  of  (4-5)  with  controls  (4-11),  where  7 ,(•)  is  a 
linear  combination  of  terms  of  the  form 


uaj  fj(x,  x)  sin (rrijivt) 
lu^  gj(x,  x)  cos (njut), 

such  that 

Xi(t )  -  Xi{t)  =  o{ a;-1),  t  G  [0,T] 


(4.25) 


(4.26) 
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Proof:  Since  X\  of  (4.5)  with  control  (4.11)  is  explicitly  integrable  the  estimate 

for  xi  is 

Xi(t)  =  X\  (t)  =  Xi  (t)  +  2u;“7+T. 

As  can  be  seen  from  the  proof  of  Theorem  4.2.1  or  from  applying  controls  (4.11) 
with  terms  a,;  accordingly  modified  to  a  power  form  system  (4.7),  the  states 
Xi,  i  —  2,  3, . . .  n  can  be  written  as 

Xi{t)  =  /  I/0  i(x(T),x(T))  +  Ui(T,UJ,x(T),x(T))dT, 

Jo 

where  under  the  given  assumptions  the  terms  subsumed  under  ( ■ )  add  up  to 
give  Voi(x(r),  x(t))  =  X\  (r)  and  i/j(-)  is  a  linear  combination  of  terms  of  the  form 
(4.25).  Applying  integration  by  parts  results  in 

Xi{t)  =  Xi{t)-kli{t,u,x,x)~  /  r)i(r,uj,x,x)  dr. 

Jo 

The  terms  7 *(•)  and  97*  (-)  are  again  a  linear  combination  of  term  of  the  form  (4.25) 
where,  for  instance,  a  term  a fa  gj(x,x)  cos(rijUJT )  taken  from  !/*(•)  enters  7 *(•) 
as  tufa-1  gj(x,x)  sm(n,jUJT )  and  77* (-)  as  u A  (gj(x,x))  sin (njur).  It  follows 
from  the  proof  of  Theorem  4.2.1  that  both  7 ,(•)  and  77* (•)  are  of  order  —7^7  in 
u)  and  that  therefore  by  Lemma  4.2.2 

rji(r,  uo,  x,  x)  dr  =  o(a;_1^’rrT). 

Setting  Xi(t )  =  Xi(t )  +  7,(f,  u,  x,  x)  therefore  yields 

Xi(t)  -  Xi{t)  =  o{ a;-1),  i  —  2,3, . . .  ,n. 


□ 
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Chapter  5 


Nilpotentization  of  Invariant  Systems 
on  Matrix  Lie  Groups 


As  pointed  out  above,  the  study  of  certain  control  problems  is  greatly  facilitated 
for  nilpotent  systems  since  they  are  integrable  by  quadratures  and  due  to  their 
relatively  simple  Lie  algebra  structure. 

In  particular,  since  as  shown  in  Theorem  4.2.1  the  approximate  tracking 
problem  can  be  solved  with  relatively  simple  controls  for  chained  form  systems 
the  question  arises  as  to  what  class  of  systems  and  how  one  can  construct  trans¬ 
formations  bringing  non- nilpotent  systems  into  chained  form  or,  more  generally, 
making  these  systems  nilpotent. 

This  process  which  we  henceforth  call  nilpotentization  is  comparable  to  the 
technique  of  feedback  linearization  in  that  here,  as  there,  a  certain  class  of  nonlin¬ 
ear  systems  characterized  by  conditions  on  their  associated  Lie  algebra  of  vector 
fields  is  transformed  by  a  feedback  transformation  to  a  canonical  form.  For  feed¬ 
back  linearization  this  canonical  form  is  the  class  of  controllable,  linear  systems 
for  which  an  abundance  of  control  results  exist.  Nilpotent  systems,  and  in  par¬ 
ticular  chained  form  systems,  can  therefore  be  seen  as  providing  such  a  canonical 


68 


form  for  another  class  of  nonlinear  systems  which  can  be  made  nilpotent  by  a 
state-feedback. 

Given  an  input-affine  system  of  the  type 

S:  x  =  f0(x)  +  fi{x)ui  d - | x  e  M  (5.1) 

defined  on  a  n-dimensional  manifold  M  with  m  <  n,  assume  that  the  real- 
analytic  vector  fields  fi,  i  —  0, 1, . . . ,  to  are  linearly  independent  around  a  point 
p  G  M,  span  the  distribution  A  =  span {/0,  fi, ... ,  fm},  and  generate  a  Lie  alge¬ 
bra  L(/q,  fm)(x)  of  vector  helds  of  dimension  n  around  p.  Nilpotentization 

of  (5.1)  then  amounts  to  finding  a  nilpotent  basis  for  the  input  distribution  A. 
Since  the  analysis  in  this  chapter  is  of  local  nature,  we  will  assume  for  simplicity 
of  notation  that  E  is  already  defined  on  K"  as  a  local  representation  of  a  system 
on  a  manifold  M. 

The  availability  of  a  nilpotent  basis  for  A  has  different  consequences  depend¬ 
ing  on  whether  or  not  a  drift  vector  held  /o  is  present.  For  drift-free  systems  E 
the  existence  of  nilpotent  basis  for  A  implies  that  there  exists  a  locally  invertible 
(to  x  TO)-matrix  H(x )  such  that  using  the  feedback  u  =  H(x)v  the  system  E  is 
transformed  to 

E nil  '■  x  =  F(x)H(x)v  =  G(x)v  (5.2) 

where  the  columns  gi(x), . . . ,  gm(x)  of  G(x)  are  again  real-analytic  vector  helds 
forming  a  nilpotent  basis  for  A.  The  nilpotent  system  then  is  locally  trajectory 
equivalent  to  E  in  the  sense  that  any  trajectory  x*(-)  of  E  can  be  achieved  by  E nii 
with  control  v*  =  iL_1(x*)w*  as  long  x(-)  remains  within  the  region  for  which 
H(x)  is  invertible. 

To  transform  E  in  particular  to  a  chained  form  system  the  Lie  algebra 
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L(gi, . . . ,  (jm)  has  to  be  isomorphic  to  the  Lie  algebra  generated  by  the  corre¬ 
sponding  chained  form  vector  fields  and,  in  general,  a  coordinate  transformation 
T  has  to  be  applied  to  Hnu  since  the  notion  of  a  chained  form  system  is  coordinate 
dependent. 

As  shown  in  (Hermes  et  al,  1984)  the  existence  of  a  nilpotent  basis  for  A 
for  a  system  with  drift  implies  only  the  weaker  notion  of  orbit  equivalence ;  i.e. 
using  an  affine  feedback  transformation  u  =  h(x)  +  H(x)u  the  resulting  system 
E nu  can  locally  trace  the  same  orbits  in  state  space  as  E  although  in  general  not 
with  the  same  time  parameterization  as  E. 

The  dual  description  of  E  in  terms  of  a  set  of  independent  one-forms  repre¬ 
senting  the  corresponding  nonholonomic  constraints  allows  us  to  pose  the  ques¬ 
tion  of  nilpotentization  equivalently  in  the  cotangent  setting.  Namely,  given  a 
set  of  independent  one-forms  {aq(x), . . . ,  an-m(x )  annihilating  A  we  are  looking 
for  a  change  of  coordinates  S  such  that  cq,i  =  l,...,n  —  m  assume  the  form  of 
the  one-forms  (3i,i  =  1, . . . ,  n  —  m  characterizing  a  compatible  nilpotent  system. 

In  particular,  for  nilpotentization  to  a  chained  form  systems  it  has  been 
pointed  out  by  Murray  (Murray,  1994)  that  the  one-forms  characterizing  chained 
form  systems  are  in  Goursat  normal  form  allowing  the  use  of  the  machinery  and 
the  results  of  the  theory  of  exterior  differential  systems  (see  (Bryant  et  al.,  1991)). 
The  sufficiency  conditions  for  the  existence  of  a  nilpotentizing  transformation  to 
chained  form  systems  have  been  established  in  this  setting. 

Nevertheless,  in  both  the  tangent  and  the  cotangent  space  setting  the  de¬ 
termination  of  the  coordinate  transform  T  requires  in  general  the  solution  of  a 
partial  differential  equation.  Moreover,  the  transformation  to  a  certain  nilpotent 
form  is  non-unique,  since  there  always  exist  a  multitude  of  transformation  H(x) 
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and  T(x)  achieving  this  transition. 

We  will  show  in  Section  5.1  that  for  a  wide  class  of  three-dimensional  systems 
on  matrix  Lie  groups  the  transformation  T  can  be  computed  directly  from  the 
structure  of  the  Lie  algebra.  This  allows  in  principle  to  solve  the  nilpotentization 
problem  for  this  class  of  systems  with  an  algorithm  implementable  on  a  symbolic 
computing  package.  After  a  review  of  the  necessary  and  sufficient  condition  for 
nilpotentization  we  study  in  Section  5.2  the  problem  of  nilpotentization  for  higher 
dimensional  matrix  Lie  groups  paying  special  attention  to  Lie  groups  arising  from 
the  kinematics  of  mechanical  devices. 


5.1  Nilpotentization  of  Invariant  Systems  on  Three- 
Dimensional  Matrix  Lie  Groups 

Three-dimensional  matrix  Lie  groups  are  of  theoretical  interest  since  they  allow 
a  classification  of  their  algebraic  structure  into  a  tractable  set  of  equivalence 
classes  of  Lie  algebras  and  therefore  a  complete  treatment  of  nilpotentization 
for  the  corresponding  nonholonomic  systems.  They  are  also  of  practical  interest 
since  the  rigid  motions  on  the  plane  and  rigid  reorientation  in  three-space  can 
be  modeled  by  the  three-dimensional  Lie  groups  SE(2)  and  SO( 3)  respectively. 

Classification  of  nonholonomic  systems  on  three-dimensional  Lie  groups  re¬ 
quires  the  classification  of  three-dimensional  Lie  algebras  as  well  as  within  each 
isomorphism  class  of  Lie  algebras  the  classification  of  two-dimensional  subspaces 
which  are  not  subalgebras.  This  is  achieved  in  the  following  classification  listing 
the  three-dimensional  Lie  algebras  along  with  their  commutation  relations  with 
respect  to  a  basis  {A3,  A2,  A3}  and  Proposition  5.1.1  both  taken  from  (Vershik 
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&  Gershkovich,  1994). 


Classification  of  Three-Dimensional  Lie  Algebras: 

1.  Abelian  Lie  Algebra  t(3) 

2.  Nilpotent  Heisenberg  Lie  algebra  f)  (3) 

[Ai,A2]  =  A3 ,  [A1?  A3]  =  [A2,A3]  =  0 

3.  Solvable  Lie  algebras: 

[Ah  ^2]  =  cluAi  +  ai2A3,  [A2,  A3\  =  a2iAi  +  a22A3,  [Ah  A:i\  =  0 

/ 

an  ^12 

A  = 

y  a21  a22 

Depending  on  the  eigenvalues  of  A  we  distinguish  between  the  following 
subclasses: 

(a)  A  is  diagonal 

an  =  a22  =  1,  ai2  =  a22  =  0 

(b)  A  has  different  real  eigenvalues  Ai  7^  A2 

&11  =  Ai,  a22  =  A2,  ai2  =  a2i  =  0 

(c)  A  is  conjugate  to  a  rotation  (0  =  |  — >•  sc(2)) 

an  =  cos  4>,  au  =  sin  0,  a2i  =  —  sin  q b,  a22  =  cos  (j) 

(d)  A  is  conjugate  to  the  Jordan  matrix 

an  =  a22  =  ai2  =  1,  a2i  =  0 


\ 

e  SL( 2,R) 


72 


4.  Semi-simple  Lie  algebras 


(a)  Special  orthogonal  Lie  algebra  so  (3) 

[Ai,  A2]  =  ^3,  [Ai,^]  =  —  A2,  [^2,^3]  =  Ai 

(b)  Special  linear  algebra  sl(2) 

[^1,^2]  =  A3,  [^1,^3]  =  —2Ai,  [A2,  A3]  =  2A2 

Proposition  5.1.1  There  are  no  nonholonomic  left-invariant  distributions  ei¬ 
ther  on  the  Abelian  group  T( 3),  or  on  the  solvable  group  of  type  3(a). 

For  the  groups  H(3),  the  solvable  groups  of  type  3(b),  3(c),  3(d),  and  the 
group  SO  (3)  all  nonholonomic  left-invariant  distributions  lie  on  the  same  orbit 
of  the  group  of  automorphisms  of  the  corresponding  Lie  algebra. 

The  set  of  nonholonomic  left-invariant  distribution  on  SL( 2)  splits  into  two 
orbits  represented  by  the  subspaces  V\  =  span{A\,  A2}  and  V2  =  span{A\  + 

A2,  a3}. 

In  the  following  Lemma  we  show  that  the  product  of  exponentials  represen¬ 
tation  of  a  nonholonomic  system  has  under  a  mild  condition  on  the  Lie  algebra 
structure  a  special  form  which  turns  out  to  be  of  advantage  for  nilpotentization. 

Lemma  5.1.2  Consider  a  left-invariant  system 

X  =  X[AiUi  +  A2u2  +  A3U3),  X  G  G,  Ai  G  0,  i  =  1, 2, 3  (5-3) 

on  a  three-dimensional  matrix  Lie  group  G  and  let  the  associated  Lie  algebra 
0  =  span{Ai,  A2,  A3}  be  such  that 

[dli,  ^2]  =  A3  (5-4) 

L  %  =  0  i  =  l,2.  (5.5) 
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Then  the  local  product  of  exponentials  representation  of  (5.3)  has  the  form 


( 


x  = 


\  GA 


fn(x)  fn(x)  0 

./* 2 1  (x)  f22(x)  0  U2  (5-6) 

\  hi(x)  f32(x)  i  y  y  u3  j 

and  there  exists  a  diffeomorphism  h  :  M  — >  M;  x2  (->•  h(x2)  with  h( 0)  =  0  such 
that 

fu  h(x 2)  =  -f3i  *  =  1,2.  (5.7) 


Proof:  Given  a  X  e  G  in  a  sufficiently  small  neighborhood  of  the  identity 

of  G  we  can  write  X  =  exlAleX2A2eX3As ,  where  the  Xi,  i  =  1,2,3  are  the  single 
exponential  coordinates  for  G.  Differentiating  and  using  AeA  =  eAA  as  well  as 


eABe~A  =  ead{A)  B  =  B  +  J2~  adkAB  A,  B  e 


k= 1 


0 


we  obtain: 


dX 

dt 


d 

dt 


^,XlA\  (,X2A2  g*3^3^ 


=  i'i  eAlXlAieA2X2eA3X3  +  x2  eAlXleA2X2A2eA3X3  +  x3  eAlXl  eMx2  eAiX3  A3 
=  eXlAleX2A2eX3A3  (iq  e~x3A2  Ai&a2x2  eA3x3  +  ^  +  ^  ^ 

=  X  (ii  ead(-^3)ead(-^2)Ai  +  ±2  gacK  —X3A3) +  ^  ^ 

Setting  this  equal  to  the  right  hand  side  of  (5.3)  yields 
AlUl  +  A2u2  +  7L3«3  =  X\  e™*G*3A3)ea4(-x2A2)Ai  +  ±2  ead(-x3A3)A2  +  ^  ^  (g.g) 

Let  {Tl^, . . . ,  b.<4n}  be  a  basis  for  the  dual  space  g*  of  the  Lie  algebra  g  such 
that 


A\(Aj)  =  Sj ,  i,  j  =  1 
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i.e  A  projects  vectors  in  g  to  their  component  in  the  direction  associated  with 
A{.  Then  it  follows  by  (5.5)  that 

Aj’3(ead(~X3A3)A2 )  =  0  Vx3  £  M  (5.9) 

A^ead(-X3A3)ead(-X2A2)Al)  =  A^e^-^A^,  Vx3  £  R.  (5.10) 


Introducing  the  notation  771  =  eadA^M) ead(-x2A2) A^  ^  _  ead(-x3A3)  A^^  anc[ 
t]3  =  ead(~x^A2) Ai  and  using  (5.9),  (5.10),  as  well  as  the  fact  that  {A3,  A2,  A3} 
forms  a  basis  for  g  we  can  rewrite  (5.8)  as 


A(Vi)  AM 
A(vi)  AM 

y  Aids)  0 
=  M(x)x. 


The  product  of  exponentials  representation  x  =  M(x)u  of  (5.3)  can  then 
obtained  by  setting  M(x)  =  M-1.  As  a  consequence  of  the  form  of  M  it  turns 
out  that 


AM  AM  -  AM  AM 


A(v  2)  -A(v  2)  0 

M~  ™  ~  AMAM  -  AMAM  ~AM  Ain  1)  0 

y  -AMAM  AMAM  1 

(5-11)" 

from  where  it  follows  that  h  =  A  [Vs)-  Since  with  (5.15) 

k 

V3  =  eaA-X2A2)Ai  =  Ai+J2(-l)k^adkA2Ai 

k= 1 

=  (1  +  o(xl))A1  +  o{x\)A2  +  (x2  +  o{x22))  A3 


the  function  h  is  indeed  a  local  diffeomorphism  depending  on  x2  only  and  //(())  = 
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□ 

Note  that  the  familiar  matrix  Lie  groups  H( 3),  SE( 2),  SL( 2),  and  SO (3) 
which  form  a  “nearly”  exhaustive  set  of  representatives  for  three-dimensional 
Lie  groups  exhibiting  nonholonomy  (leaving  aside  only  the  solvable  cousins  of 
SE(2))  all  satisfy  the  conditions  (5.4)  and  (5.5). 

For  drift-free,  three-dimensional  nonholonomic  systems  of  form 

x  =  /i(x)ui  +  /2(;c)m2,  x  G  Rn 


the  problem  of  nilpotentization  is  best  approached  in  the  cotangent  formulation 
and  can  be  shown  to  always  have  a  solution  (see  Theorem  5.2.2).  Let  the  one- 
form 

a(x )  =  a\dxi  +  a2(Lc  2  +  &3dx3 


be  such  that 


a(fi)(x)  =  0,  *  =  1,2 


and  define 

fd(y)  =  ~V2dyi  +  dy3 

as  the  one-form  annihilating  the  vector  fields 


.  d  d 

<j\\y)  =  w— +  ?/2w— 

oyi  oy3 


92{y)  = 


_d_ 

dy2 


of  a  three-dimensional  chained  form  system.  The  problem  of  nilpotentization  is 
then  reduced  to  finding  a  coordinate  transformation  T  :  R3  — y  M3  satisfying 


a(x)  =  (3(T(x)) 


dT\ 
dx  ) 


(5.12) 
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The  following  Theorem  shows  how  for  a  wide  class  of  nonholonomic  systems 
on  three-dimensional  matrix  groups  T  and  H(x)  can  be  directly  determined  from 
the  Lie  algebra  structure  as  a  “byproduct”  of  the  computations  for  the  product 
of  exponentials  representation.  It  is  this  choice  of  coordinates  which  simplifies 
nilpotentization  greatly  which  is  not  surprising  since  we  saw  in  Chapter  4  that 
the  chained  form  system  is  itself  in  product  of  exponential  coordinates.  The 
especially  simple  form  of  T,  i.e.  T\{x )  =  x\ ,T2(x)  =  h(x2),T3(x)  =  x3,  obtained 
with  this  algorithm  will  be  of  advantage  for  motion  control  applications. 


Theorem  5.1.3  Consider  a  left- invariant,  nonholonomic  system 

X  =  X(AiUi  +  A2u2),  X  £  G,  Ai,  A2  £  0,  (5.13) 


on  a  three-dimensional  matrix  Lie  group  G  and  its  local  product  of  exponentials 
representation 

x  =  fi(x)u!  +  f2(x)u2  (5.14) 

relative  to  the  basis  {Ai,  A2,  A3}  for  g.  Assume  that 

[Ai,  A2]  =  A3  (5.15) 

=  0  i  =  1,2.  (5.16) 


Then  the  one-form  a  annihilating  A  =  span{/i(x),  f2(x)}  can  be  specified  as 
a  =  Al(ead(~X2A2'> A±)  dx  1  +  dx 3  and  is  related  to  the  one-form  (3  =  —y2dyi  +  dy3 
by  the  change  of  coordinates 


T  :  R3  ->•  E3 , 


Xi 

X2 

-> 

•X'3  j 

Xi 

-A^e^-^^Ai) 

^3 


(5.17) 
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which  uniquely  determines  the  feedback  transformation  H(x )  making  (5.14) 
nilpotent. 


Proof:  It  follows  directly  from  Lemma  5.1.2  that  the  transformation  equation 

a{x )  =  /3(T(x ))  (^)  is  satished  by  a  and  T  as  specified  above. 

The  nilpotent  basis  {gi,g2}  for  A  on  the  other  hand  is  determined  from  the 
vector  fields  g\  =  -^-  +  2/2^,  92  =  ^  of  the  chained  form  system  by  the  induced 
tangent  map 


dS 


fdT\~ 1 


9i(x)  =  -5- 9i{S  (x))=  —  &(T(x)) 


dx 

of  S  =  T _1,  i.e.  with  (5  =  (gig2)  we  obtain 


\dx  ) 


( 


G  = 


\ 


0  (it 


V  w 


with  T2(x)  =  — Ajj^e0^  *2A2Mi). 

Letting  e3  =  (0  0  1)T,  Fext  =  (/i(x)  /2(x)  e3),  Gext  =  (gi  g2  e3),  the  desired 
feedback  transformation  if  (x)  is  uniquely  dehned  by 


(  H(x)2x 2 


0  N 
0 


V  0  0  1  / 


Since  F^xt  =  M  (see  proof  of  previous  Lemma)  it  follows  that  H(x)  is  completely 
determined  by  the  terms  required  for  the  derivation  of  the  product  of  exponential 
representation: 


Asm 

v  AM  -AM'-^tr  , 


(5.18) 


□ 
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In  the  following  examples  we  apply  the  procedure  presented  in  Theorem  5.1.3 
to  nonholonomic  systems  on  the  non-nilpotent  matrix  Lie  groups  SE(2),  SL( 2), 
and  SO( 3).  Their  corresponding  Lie  algebras  satisfy  the  conditions  (5.15),  (5.16) 
and  the  feedback  and  state  transformation  required  for  nilpotentization  of  these 
systems  can  be  obtain  directly  from  the  A\(rjj)- terms  required  for  the  derivation 
of  the  product  of  exponentials  representation. 


Example  5.1.4  Consider  the  system  (5.13)  on  G  =  SE( 2)  with  a  basis  for  g 
spanned  by 


^  0  -1  0  ^ 


Ai  = 


V 


1  0  0 
0  0  0 


^001^ 


Ao  — 


V 


0  0  0 
0  0  0 


/ 


A-i  — 


0  0  0 
0  0  1 
0  0  0 


From  the  resulting  bracket  structure 


|/4i5  ^2]  —  7f3,  [^4.1 5  ^.3]  —  ~A2,  [^4-2,  ^4.3]  —  0 


\ 


we  obtain 


ead(-x2A2)Ai  =  Al+X2A3  =  r]3 

ead(-x3A3)ead(-x2A2)Ai  =  Al  -  X3A2  +  X2A3  =  Vl 

ead(-x3A3)A2  =  A2  =  r]2 


and  the  product  of  exponentials  representation  turns  out  to  be 


( •  \ 

(  ^  n  \ 

Xi 

1  0 

/  \ 

Ml 

X2 

= 

x3  1 

V*3 ) 

y  ~x2  0  j 

\U2J 
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With 


Example  5.1.5  Consider  the  system  (5.13)  on  G  =  SL( 2)  with  a  basis  for  g 
spanned  by 


From  the  resulting  bracket  structure 

[Ai,  A2\  —  A3,  [Ai,  A3]  = —2  Ai,  [A2 ,  ^3]  =  2  A2 

we  obtain 

ead(~X2A2)Ai  =  A1-xlA2  +  X2A3  =  V3 

ead{-x3A3)ead(-x2A2)Ai  =  e~2x3  ^  _  ^2x3^  +  =  ^ 

ead(-x3A3)A2  =  e2x3A2  =  ^ 
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and  the  product  of  exponentials  representation  turns  out  to  be 


/ 


E  : 


x  = 


-2x 3  g 


\ 


_ /^»2  ^2x3  ^2x3 


—x2e2x3  0 


V“2/ 


With 


/ 


H(x)  = 


3-2*3 


V 


_ ^2x^  _ ^2xq 


\ 


the  feedback  law  u  =  H(x)v  transforms  E  to  the  trajectory  equivalent  nilpotent 
system 


/ 


Jnil 


X  = 


1  o 

o  -1 


\ 


00 

\V2/ 


(5.21) 


y  -x2  o  j 

which  is  state-equivalent  to  E cfs  via  the  change  of  coordinates 


y  =  T(x)  = 


/  *  \ 


~x2 

V  *3  J 


(5.22) 


Example  5.1.6  (SO( 3))  Consider  the  system  (5.13)  on  G  =  50(3)  with  a  basis 
for  g  spanned  by 

^  0  0  1  \ 

0  0  0 
-10  0 


^  0  0  0  ^ 


A\  — 


V 


oo-i 

0  1  0 


Ao  — 


J 


\ 


(  0  -1  0  ^ 


J  A3  — 


/ 


V 


1  0  0 
0  0  0 


/ 


From  the  resulting  bracket  structure 


[v4i ,  ^4.2]  —  A3,  [A\,  A3]  —  —  A2,  [A2,  A3]  —  A\ 
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we  obtain 


ead{-x2A2)  ^  _  COs  x2A\  +  sinrc2kl3  =  rj3 

ead(~x3A3)ead(-x2A2)^  _  cog  ^  cog  x _  cog  x<2  gjn  X:iA2  +  sin  £2t43  =  Tji 

ead(-x3A3)  =  sin  £3^  -I-  QOSX3A2  =  TJ2, 


and  the  product  of  exponentials  representation  turns  out  to  be 


/ 


£  : 


x  = 


\ 


sec  x2  cos  x3  —  sec  x2  sin  x3 
sin  x3  cos  x3 

y  —  tan  x2  cos  x3  tan  x2  sin  rc3  J 

With 

/ 

cos  x2  cos  x3  —  sec  x2  sin  x3 
—  cos  x2  sin  x3  —  sec  x2  cos  x3 
the  feedback  law  u  =  H(x)v  transforms  £  to  the  trajectory  equivalent  nilpotent 
system 


H(x)  = 


\ 

u  1 

V"2/ 

\ 

/ 


/ 


Jnil 


X  = 


1 

0 


0 


\ 


V 


\”2/ 


) 


—  sec  x2 
—  sin  x2  0 

which  is  state-equivalent  to  £ cfs  via  tbe  change  of  coordinates 


(5.23) 


y  =  T(x)  = 


(  „  t 


—  sin  x2 

x3 


(5,24) 


For  motion  control  applications  it  is  of  interest  to  have  the  transformations 
T(x)  and  H(x)  dehned  on  a  neighborhood  U  C  Mn  of  the  origin  as  large  as 
possible.  For  Examples  5.1.4  and  5.1.5  the  change  of  coordinates  T(x)  is  a 


82 


diffeomorphism  and  H(x)  is  a  well  defined  invertible  feedback  transformation  for 
all  finite  x  G  R" .  For  Example  5.1.6  T(x)  and  Ii (x)  have  the  desired  properties 
for  x  G  U  =  {x  =  (xi,x2,x3)  G  Rn\x2  G  (— | ,  f)}.  Thus,  in  all  three  cases  T 
and  H  are  valid  on  the  whole  domain  for  which  the  local  representation  of  the 
invariant  system  itself  is  valid,  and  nilpotentization  therefore  does  not  restrict 
the  domain  allowed  for  x  any  further. 

5.2  Nilpotentization  for  Higher-Dimensional  Sys¬ 
tems  on  Matrix  Lie  Groups 

In  this  section  we  study  the  problem  of  nilpotentization  for  systems  on  higher 
dimensional  matrix  Lie  groups  paying  special  attention  to  systems  arising  as 
models  for  the  kinematics  of  mechanical  systems  or  from  other  applications. 

A  necessary  condition  for  nilpotentization  to  a  specific  nilpotent  system 
can  be  deduced  from  the  following  invariance  property  of  distributions  under 
a  change  of  basis. 

Proposition  5.2.1  ((Hermes  et  al.,  1984))  Consider  a  locally  regular  dis¬ 
tribution  A(x)  =  span{fi(x), . . . ,  fm(x)}  let  {g\, . . . ,  gm}  be  another  basis  for 
A.  Given  JF°  =  {f^x), ,  fm(x)}  define  JP  inductively  as  the  set  of  j^1- order 
brackets  of  vector  fields  taken  from  JF°  with  j  <  i  and  define  Q'  analogously  with 

G  —  {lb)  •  •  •  5  9  m}  ■ 

Then,  locally  we  have 

dim (spanJ7*)  =  dim (spanQ1),  i  =  0, 1,  2, _  (5.25) 
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Applying  an  invertible  feedback  transformation  u  =  H(x)v  to  a  drift-free  sys¬ 
tem  x  =  F(x)u  then  implies  that  distributions  span(CT)  of  the  resulting  system 
x  =  F(x)H(x)v  =  G(x)v  have  the  same  dimensionality  as  the  corresponding 
distributions  span(E*)  of  the  original  system.  The  nilpotent  model  system  to 
which  the  original  system  is  supposed  to  be  transformed  therefore  has  to  be 
chosen  to  satisfy  (5.25). 

For  the  case  of  a  two-input,  single  chain,  single  generator  chained  form  sys¬ 
tem  as  the  nilpotent  model  system,  Murray  has  derived  sufficient  conditions  for 
nilpotentization  using  tools  of  exterior  algebra  and  a  result  related  to  Goursat 
Normal  Forms. 

The  condition  is  formulated  in  terms  of  the  hltrations  { Et }  and  { Ft }  derived 
from  A(x)  =  span{/i(x), . . . ,  frn(x)}  as  follows: 


Eq 

A 

F0 

A 

El 

=  E0  +  [E0,  E0\ 

Fi 

=  E0  +  [E0,  E0 

E2 

=  E\  +  [Ei,  Ei] 

f2 

=  Ei  +  [Ei ,  E0 

Ei+ 1 

=  Ei  +  [Ei,  Ef\ 

Fi+l 

=  Fi  +  [Fi ,  E0] 

We  assume  henceforth  that  the  distributions  Ei  and  Fi  are  regular  which  is 
naturally  the  case  for  systems  arising  as  local  representation  of  systems  on  matrix 
Lie  groups.  In  fact,  for  systems  on  matrix  Lie  groups  we  can  directly  consider 
the  Lie  algebra  hltrations,  i.e.  nested  sequences  of  subspaces  of  g,  corresponding 
to  {Ei}  and  {E*}. 

Theorem  5.2.2  ((Murray,  1994))  A  feedback  transformation  which  puts  a 
system  x  =  f\{x)ui  +  f2{x)u2,  x  G  Rn  into  chained  form  (f.5)  exists  if  and 
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only  if 


dim  Ei  =  dim  Fi  =  i  +  2,  i  =  0, . . . ,  n  —  2.  (5-27) 

It  follows  from  a  count  of  dimensions  that  controllable  two-input  systems  x  = 
fi(x)ui  +  f2(x)u2  with  x  G  R3  and  x  G  R4  satisfy  the  growth  vector  condition 
(5.27)  and  therefore  always  can  be  transformed  to  chained  form. 

Revisiting  an  example  given  by  Murray  (Murray,  1994)  we  present  a  nilpo- 
tentizing  feedback  for  a  four- dimensional  system  and  show  that  if  the  original 
system  is  written  in  product  of  exponentials  coordinates  the  computations  and 
resulting  transformations  are  very  simple. 


Example  5.2.3  (Rolling  Penny)  Consider  the  kinematic  model  of  a  disk  rolling 
without  slipping  on  a  plane  as  depicted  in  Figure  5.1.  We  assume  that  we  have 
control  over  the  heading  angle  and  the  angular  velocity  which  is  proportional  to 
the  forward  velocity  due  to  the  no-slip  constraint.  The  configuration  of  the  disk 
can  be  described  by  an  element  of  SE( 2)  describing  the  location  of  the  contact 
point  of  the  penny  on  the  plane  and  by  an  element  of  SO (2)  describing  the  an¬ 
gular  displacement  of  a  fixed  line  on  the  penny  with  respect  to  the  vertical.  An 
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element  of  the  configuration  space  G  =  SE(2)  x  SO (2)  can  be  written 

^  cos  0  —  sin  (f)  x  0  n  ^ 
sin  (j)  cos  4>  y  0 

X=  o  0 
0  0 

0  0 

while  a  basis  for  g  is  given  by 


V 


0 
0 

1  0  0 
0  cos  9  —  sin  0 
0  sin  6  cos  6 


A\  — 


0 

-1 

0 

0 

0 

0 

0 

1 

0 

0 

1 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

,  a2  — 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

-1 

,  0 

0 

0 

0 

o  J 

1  0 

0 

0 

1 

0  , 

^  0  0  0  0  0  ^ 


00-100 
An  =  0  0  0  0  0 

0  0  0  0  0 

0  0  0  0  0 

/ 

The  Lie  algebra  is  not  nilpotent  since 


V 


/ 


A  = 


V 


0  0-100 
0  0  0  0  0 

0  0  0  0  0 

0  0  0  0  0 

0  0  0  0  0 


\ 


adAlA2  =  —ad\iA2. 

The  corresponding  left-invariant  system 

X  =  X(AlUl  +  A2u2),  XeG 
is  depth-two  controllable  since 

[Ai,  A2]  =  —A;  [Aii  [Ai,  A2]  =  A4. 


(5.28) 
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Using  the  product  of  exponential  coordinates  the  local  representation  of  (5.28) 


turns  out  to  be 


1 

0 

0 

1 

X  = 

Ui  + 

x2  -  £4 

0 

V  ^3  ) 

w 

u2 


(5.29) 


with  the  one-forms  cp(x),  i  =  1,2  annihilating  A(x)  =  span{/i(x), /2(£)}  given 
as 


«i(x)  =  —  (x2  —  x^dxi  +  dx3 
a2(x)  =  —x3dx  i  +  dx4. 

It  follows  immediately  that  the  change  of  coordinates  relating  cp(x),  i  —  1,2  to 
the  one-forms  fii(y)  =  — 2/2 <^J/i  +  dy 3,  (d2(y)  =  —y3dy\  +  dy4  characterizing  the 
corresponding  chained  form  system  is  given  by 

T  :  yi  =  ari;  2/2  =  (x2  -  X4);  2/3  =  £3;  2/4  =  ^4 


while  the  feedback  transformation 

H(x) 


makes  (5.29)  nilpotent. 


<  1 

x3  1 


For  a  state  space  of  dimension  five  or  higher  growth  vectors  of  E,  and  Ft 
can  occur  which  rule  out  nilpotentization  to  a  two-input,  single  chain,  single 
generator  chained  form  system. 
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Example  5.2.4  (Body-Mass  System)  Consider  the  system  (5.13)  on  G  = 
SO  (3)  with  a  basis  for  g  spanned  by 

/n 


Ai  — 


0  0 


V 


\ 

/ 

\ 

/ 

0 

0 

0  ' 

0 

0 

1 

0 

0  ' 

0 

-1 

0 

0 

0 

-1 

0 

0 

0 

0 

0 

0 

0 

1 

0 

0 

0 

0 

0 

0 

0 

,  A2  — 

-1 

0 

0 

0 

0 

Sfc. 

CO 

0 

0 

0 

0 

0 

0 

1 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

V 

V 

0 

0 

0 

0 

V 

1° 

0 

0 

0 

0 

/ 


Ad  = 


0  0  0  0  0 

0  0-100 
0  10  0  0 
0  0  0  0  0 

0  0  0  0  0 


/ 


An  = 


V 


0  0  10  0 
0  0  0  0  0 

-1  0  0  0  0 

0  0  0  0  0 

0  0  0  0  0 


\ 


J 


It  turns  out  that  the  Body-Mass  System  is  controllable  using  the  brackets 

[dll,  ^2]  =  ^3)  [^4l ,  ^4.3]  =  [dll,  [^-1,^-2]  =  —A4,  [A2,  A3]  =  [A2,  [Ai,  A2]]  =  A5, 


but  since 

{dim  Ft}2i=0  =  {2,3,5} 

does  not  satisfy  (5.27)  it  is  not  nilpotentizable  to  chained  form.  However,  this 
does  not  preclude  that  the  Body-Mass  System  can  be  transformed  to  a  nilpo- 
tent  system  with  a  matched  growth  vector  satisfying  the  necessary  condition  of 
Proposition  5.2.1. 


Example  5.2.5  (Underwater  Vehicle)  We  consider  the  kinematic  model  of 
a  underwater  vehicle  as  detailed  in  Chapter  2  and  distinguish  different  cases 
depending  on  the  numbers  of  actuators  present.  Defining  two  controls  associated 


with  elements  B\,  B2  G  se(3),  such  that  each  control  generates  a  translational 
velocity  along  and  a  rotational  velocity  about  the  same  axis  yields  a  controllable 
system  on  SE( 3).  Taking  for  instance  B4  —  A4  +  A4  and  B2  =  A2  +  A5  results 
in  a  depth-3  system  since 

Bi,  B2,  [£1}B2],  [B1,[BuB2]],  [B2,[BuB2]],  [B^iB^iB^B,]]] 

are  linearly  independent  elements  of  se(3).  But  the  resulting  growth  vector 
{dimFj}f=0  =  {2,  3,  5,  6}  does  not  satisfy  (5.27)  and  the  corresponding  system 
therefore  is  not  nilpotentizable  to  chained  form.  As  in  the  previous  example,  the 
rotational  components  associated  with  u\  and  u2  induce  a  relative  growth  of  two 
for  dim  Fj  at  i  =  2  thus  violating  the  necessary  condition  for  nilpotentization. 
Since  on  the  other  hand  a  rotational  component  in  each  of  B\  and  B2  is  necessary 
to  achieve  controllability,  we  conjecture  that  there  is  in  fact  no  two-dimensional 
subspace  of  se(3)  which  generates  se(3)  and  satisfies  the  growth  condition  (5.27). 

For  three-input  and  four- input  systems  on  SE( 3)  the  situation  is  inconclu¬ 
sive.  Since  se(3)  does  not  have  a  five-dimensional  subalgebra  the  sufficient  condi¬ 
tions  given  by  Bushnell  (Bushnell  et  al,  1993)  for  nilpotentization  to  a  m-input, 
(m  —  l)-chain,  single  generator  system  are  not  satisfied  and  the  corresponding 
constructive  procedure  can  not  be  used.  But  due  to  the  lack  of  sufficiently  strong 
necessary  conditions,  as  for  instance  in  in  Theorem  5.2.2,  nilpotentization  to  a 
m-input  chained  form  systems  can  not  be  precluded  either. 

For  systems  with  five  inputs  the  situation  becomes  conclusive  again.  Using 
the  rank  condition  based  on  Darboux’s  Theorem  given  in  Theorem  3  of  (Hermes 
et  al,  1984)  it  can  be  shown,  for  instance,  that  for  the  left-invariant  distribution 
corresponding  to  the  subspace  span{Ai, . . . ,  A5}  a  nilpotent  basis  can  be  found. 


89 


Example  5.2.6  (S'0(4))  For  two-input  systems  on  S,0(4)  a  situation  similar 
to  the  one  of  two-input  systems  on  SE( 3)  is  encountered.  In  (Jurdjevic  &  Suss- 
mann,  1972)  a  two-dimensional  subspace  is  presented  which  generates  the  six¬ 
dimensional  Lie  algebra  so (4)  but  also  fails  to  satisfy  (5.27)  having  a  growth 
vector  {dimFj}?=0  =  {2, 3,  5,  6}. 

In  the  examples  studied  we  have  seen  that  due  to  the  special  Lie  algebra 
structure  of  two-input,  single  generator  chained  form  systems  and  the  corre¬ 
sponding  restrictiveness  of  the  growth  vector  condition  (5.27)  nilpotentization 
to  this  form  is  possible  only  in  very  special  cases.  These  include  three  and 
four-dimensional  nonholonomic  system  and  those  where  the  underlying  physical 
phenomena  reflects  the  chained  structure  as  illustrated  by  the  tractor  and  trailer 
system. 

More  work  needs  to  be  done  to  clarify  the  situation  for  systems  with  codi¬ 
mension  larger  than  two.  It  would  be  desirable  to  obtain  selection  criteria  for  a 
suitable  nilpotent  model  system  based  on  the  Lie  algebra  structure  of  the  sys¬ 
tem  under  study  and  derive  constructive  procedures  to  obtain  the  corresponding 
feedback  and  state  transformations. 
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Chapter  6 


Motion  Control  For  Nilpotentizable 
Systems 


This  chapter  demonstrates  how  motion  control  problems  for  non-nilpotent  sys¬ 
tems  can  be  reduced  by  feedback  nilpotentization  to  motion  control  problems 
for  nilpotent  systems  which  often  turn  out  to  be  much  simpler. 

For  instance  the  point-to-point  steering  problem  for  a  controllable,  drift-free 
nilpotent  system  can  be  reduced  to  the  inversion  of  a  polynomial  map.  The 
steering  laws  presented  in  (Leonard  &  Krishnaprasad,  1995),  which  steer  generic, 
drift-free,  invariant  systems  on  matrix  Lie  groups  into  a  o(e“)  neighborhood  of 
the  target  point  (where  a  depends  on  the  order  of  averaging  employed),  can 
therefore  be  made  precise  for  the  case  of  a  nilpotentizable  system. 

We  start  by  extending  the  approximate  inversion  control  law  obtained  in 
Chapter  4  to  drift-free  systems  which  are  nilpotentizable  to  chained  form.  Due 
to  the  feedback  terms  in  the  nilpotentizing  input  transformation  the  resulting 
control  law  will  not  be  open-loop  anymore.  Section  6.2  shows  how  these  con¬ 
trol  can  be  converted  to  open-loop  form  again  using  an  estimate  of  the  state 
such  that  the  resulting  control  law  can  also  be  interpreted  as  an  approximate 
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inverse  system.  Even  though  approximate  tracking  via  feedback  nilpotentization 
is  less  general  than  for  instance  the  method  of  Liu  and  Sussmann  (Sussmann  & 
Liu,  1991),  it  has  advantages  steering  the  system  along  trajectories  of  feedback 
equivalent  nilpotent  systems.  For  instance,  if  one  needs  to  compute  the  exact 
trajectory  resulting  from  a  specific  control,  say  for  example  in  an  iterative  motion 
planning  scheme,  an  inversion  scheme  based  on  nilpotentization  has  the  advan¬ 
tage  that  efficient  quadrature  algorithms  can  be  used  to  carry  out  the  forward 
integration  of  the  system. 

We  conclude  this  chapter  by  giving  feedback  laws  which  exponentially  stabi¬ 
lize  equilibria  of  local  representations  of  invariant  systems  on  three-dimensional 
matrix  Lie  groups  drawing  on  Morin’s  construction  procedure.  (Morin  et  al, 
1996). 

6.1  Approximate  Tracking  and  Approximate  In¬ 
version 

Let 

E  :  x  =  F(x)u  =  fi(x)ui  +  /2(x)rt2,  x  G  Rn,  u  G  R2  (6.1) 

be  a  input-linear  system  which  is  nilpotentizable  to  two-input,  single  genera¬ 
tor,  single  chain  form.  Thus,  locally  there  exists  an  invertible  linear  feedback 
transformation  H(x )  and  a  change  of  coordinates  T  such  that  the  system 

E nil  '■  x  =  F(x)H(x)v  =  G(x)v,  x  G  R",  v  G  R2  (6.2) 

is  state-equivalent  to  the  two- input,  single  generator,  single  chain  system 

S Cfs  :  y  =  G(y)v,  x  G  Rn,  v  G  R2,  (6.3) 
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i.e.  we  have  G(y)  =  %{T  \y))G(T  \y)). 

Then,  given  a  sufficiently  smooth  desired  trajectory  x(t),  t  G  [0,  T]  for  E 
satisfying  x(0)  =  x(0)  =  0,  let  y(t)  =  T(x(t)),  t  G  [0,  T]  be  the  corresponding 
desired  trajectory  for  the  state-equivalent  system  E cfs.  Let  VG)  —  YjJs{y)  denote 
the  approximate  inversion  controls  for  E cfs  specihed  in  Theorem  4.2.1  and 
the  trajectory  of  E cfs  with  controls  From  Theorem  4.2.1  it  follows  that 

lim  y{“\t)  =  y(t),  t  e  [0,T\ 

o;— >-oo 

where  convergence  is  uniform  with  respect  to  t.  Now,  using  as  input  for  E nu 
and  denoting  the  resulting  trajectory  by  x^  it  follows  since  T  is  assumed  to  be 
a  diffeomorphism  that 

lim  x^(t)  =  lim  T_1  (y^ft))  =  T (y(t))  =  x(t),  t  G  [0, T],  (6.4) 

a;— >-oo  u;— >-oo  v  7 

Finally,  we  obtain  the  approximate  tracking  controls  for  E  as 

u  =  H(x)vW  =  H(x)^)s(y). 

To  summarize  the  preceding  development: 

Proposition  6.1.1  Consider  an  input-linear  system  E  :  x  =  fi(x)ui+f2(x)v,2,x  G 
nilpotentizable  to  a  two-input  single- generator  chained  form  system  (6.3), 
and  a  sufficiently  smooth  desired  trajectory  x(t),  t  G  [0,  T]  for  E  satisfying 
x(0)  =  x(0)  =  0.  Let  denote  the  trajectory  of  E  with  controls 

u  =  H(x)£~],  (T (x))  (6,5) 

where  H(x),  E ~JS,  T  are  as  specified  above.  Then 

lim  x^\t)  =  x(t),  t  G  [0,  T] 

LO^-OO 

where  convergence  is  uniform  with  respect  to  t. 
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Using  Corollary  4.2.3  instead  of  Theorem  4.2.1,  Proposition  6.1.1  can  be 
straightforwardly  extended  to  include  m-input,  input-linear  systems  E  which 
are  nilpotentizable  to  an  m-input,  single  generator,  chained  form  system.  One 
can  obtain  approximate  tracking  controls  for  systems  nilpotentizable  to  systems 
other  than  single  generator  chained  form  systems  equally  well,  but  the  case 
considered  above  has  special  significance  since  the  approximate  inversion  controls 
of  Theorem  4.2.1  have  an  especially  simple  form. 

The  above  approach  to  tracking  for  nonholonomic  systems  is  illustrated  in 
Figure  6.1  and  the  following  example. 


Approximate  Inverse  of  Nilpotentized 

Nilpotentized  System  System 

Figure  6.1:  Approximate  tracking  for  nilpotentizable  systems 


Example  6.1.2  (SO( 3))  Consider  the  product  of  exponentials  representation 
of  a  two-input,  drift-free,  left- invariant  system  on  SO( 3)  presented  in  Example 
5.1.6.  Then,  with  the  nilpotentizing  transformations  T  and  H(x)  derived  there 
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the  approximate  tracking  controls  (6.5)  turn  out  to  be 


u  = 


where 


H{x)  £c7s(T(x)) 

(  (x\))  +  2 cos ojt 

^  £{T(x2))-u-*ai8mut)  ) 
cos  x2  cos  x3  —  sec  x2  sin  x3  ^  ^ 


H(x 

( 

—  cos  x2  sin  x3  —  sec  x2  cos  x3 


1 


\ 


x\  +  2w2  cos  cut 

-  -  —1 
—x2  COS  X2  —  CO  2  cti  Sill  out 


\ 


(6.6) 


«i  =  ^( T{x3 ))  -  jt{T{xi))T(x2)  =  x3  +  Xi  sin x2. 


Simulations  for  approximate  tracking  controls  derived  by  nilpotentization 
turn  out  to  be  identical  to  the  simulations  presented  in  Chapter  4  if  numerical 
errors  are  neglected. 


Note  that  due  to  the  feedback  occurring  in  H (x)  the  control  law  (6.5)  cannot 
be  interpreted  as  providing  an  approximate  inverse  system  independent  of  the 
original  system  S. 


6.2  Approximate  Inversion  of  Nilpotentizable 
Systems 

In  certain  practical  applications  it  might  be  costly  or  even  impossible  to  measure 
the  current  state  of  the  system.  Also  the  nature  of  the  controls  at  our  disposal 
might  preclude  an  on-line  modification  of  the  controls  (see  e.g.  (Dahleh  et  al, 
1996)).  For  these  cases  it  would  be  desirable  to  convert  the  approximate  tracking 
controls  derived  above  into  an  open-loop  form. 
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Even  though  lim^oo  x^d  =  x,  replacing  the  current  state  x  in  the  approx¬ 
imate  tracking  control  law  u  =  H(x )  E ~Js  (T  (. x ))  =  H(x)v^  simply  by  x  does 
not  guarantee  that  the  resulting  open-loop  control  u  =  H(x)v(uJ>  achieves  ap¬ 
proximate  tracking.  This  is  due  to  the  fact  that  the  control  for  T,nu  depends 
itself  on  the  frequency  parameter  u,  for  instance  using  the  approximate  inversion 

/  re  — 2 

control  given  in  Theorem  4.2.1  we  have  v(u>>  =  oioj™-1).  Thus,  since  in  this  case 
_  x  =  the  convergence  of  H(x^)  to  H(x)  is  not  sufficiently  fast, 

and  we  have 

Um^iHix)  -  H(xW))vW  ±  0 

in  general. 

But  since  the  state  of  x  of  E  :  x  =  F(x)u  can  also  be  interpreted  as  the 
state  of  E nii  :  x  =  F(x)H(x)v,  which  is  state-equivalent  to  the  chained  form 
system  (6.3)  and  can  therefore  be  integrated  by  quadratures,  we  can  obtain  a 
better  open-loop  approximation  to  H(x).  The  first  possibility  is  to  directly  use 
the  quadrature  solution  of  Emi  as  a  state-estimate.  But  using  Lemma  4.2.8  we 
can  also  obtain  a  sufficiently  good  estimate  x*  for  x,;,  i  =  1,2, . . .  ,n  based  on 
elementary  functions  in  the  components  of  x  and  x. 

Given  the  states  yfJ'1 ,  i  =  1,2, ...,ra  of  Ec/S  with  approximate  inversion 
controls  v^\  let  y*  be  an  estimate  for  y ^  as  specihed  in  Lemma  4.2.8  satisfying 
—  jji  =  o(w_1).  Then,  since  T  is  assumed  to  be  a  local  diffeomorphism  and 
with  T_1(-)  =  (Tf1,  T2_1, . . . ,  T^1),  Xj  =  Tf1(y^)  provides  an  estimate  for  the 
state  x\u)  of  T,nii  with  controls  such  that 

(<*>)  ~  /  -i\ 

X\  —  Xi  =  o[oj  ). 

Example  6.2.1  Consider  the  three-dimensional  chained  form  system 
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ih  =  Vi 

s cfs  :  i/2  =  V2 

y  3  =  V2Vl 

with  ?/(0)  =  0  and  approximate  inversion  controls 

v^\t)  =  y1  +  2uj2  cos(u;£ ) 

V2*\t)  =  V2  fi/3  -  y2 gi)  sin(c ot), 

a{t) 

and  a  smooth  desired  trajectory  satisfying  y  =  y  =  0.  Then  the  estimate  for  the 
resulting  state  y^\t)  is  directly 

yi(t)  =  y{u\t)  =  yi(t)  +  2 sin (ut). 

For  the  state 


i  iid 

y^\t)  =  y2{t)  +  u>~2 3a(t)  cos(ujt)  —  u>~2  /  —(a(r))  cos(lot)cIt 

Jo  dr 

" - V - " 


we  choose  the  estimate 


il2  (t)  =  y2(t)  +  U1  2Ol(t )  cos  {ut). 


For  the  state 


y^{t)  =  /  (  V2(t)  +  u)  2a(r)  cos(wr)  —  u>  2  [  —(a(a))cos(u>a)da 


'o 


i o 


da 


x  (y^r)  +  2u>2  cos(t<;r)j  dr 


=  y3(t)  +  2u>  2 y2(t)  sm(u>t)  +  -  u>  1  a(t)  sin(2o;f) 


3  •  3 

+co~2  a(t)  yi(t)  sin(o;f)  +  o(lo~2) 
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we  pick 


hit)  =  Va(t)  +  2 y2(t)  sin (ut). 

It  follows  that 

yiU\t)  ~  Vi(t)  =  o(w_1),  i  =  1,  2,  3. 

Thus,  if  is  the  state  of  a  three-dimensional  system,  two-input  system  E ni/ 
which  is  equivalent  with  Sc/s  via  the  smooth  change  of  coordinates  y  =  T(x), 
the  estimates  x,  =  T~l{y)  for  x^  also  satisfy 

xf\t)  -  Xi(t)  =  o( a;'1),  i  =  1,2,3. 

Such  estimates  turn  out  to  be  sufficient  for  converting  the  approximate  track¬ 
ing  control  law  (6.5)  into  open-loop  form  and  achieving  convergence  of  the  re¬ 
sulting  trajectory  to  the  desired  trajectory  x  in  the  high-frequency  limit.  Since 
the  resulting  control  law  is  independent  of  the  current  state  x  of  E  it  can  also  be 
interpreted  as  providing  an  approximate  inverse  system  E'  for  the  non-nilpotent 
system  E. 

Theorem  6.2.2  Consider  a  input-linear  system  E  :  x  =  fi(x)u\  +  f2(x)u2,x  G 
nilpotentizable  to  a  two-input  single- generator  chained  form  system  (6.3), 
and  a  sufficiently  smooth  desired  trajectory  x(t),  t  G  [0,  T]  for  E  satisfying  x(0)  = 
x(0)  =  0.  Let  x^  denote  the  trajectory  of  E  with  open-loop  controls 

u  =  H(x)T.y,  (T  (x))  (6,7) 

where  H(x),  E ~JS,  T ,  and  x  are  as  specified  above.  Then 

lim  x^\t)  =  x(t),  t  G  [0,  T] 

(jJ—>  OO 

where  convergence  is  uniform  with  respect  to  t. 
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Proof:  We  will  show  that  the  solution  of  E  with  open-loop  controls 

u  =  H{x)Yi~js  (T  (x))  =  H{x)v^  will  converge  to  the  solution  of  E  with 
feedback  controls  =  H(x)v bd  in  the  high-frequency  limit.  Then,  since  by 
Proposition  6.1.1  x b’)  converges  to  the  desired  trajectory  x.  also  x ^  converges 
to  x  in  the  high-frequency  limit. 

Now,  for  lim^oo  |  |x^  —  xbf>  \  |  =  0  it  is  sufficient  to  have  lim^oo  | \u  —  u\ \  =  0. 
But,  since  by  Lemma  4.2.8  and  the  argument  above  there  exists  an  estimate  x 
satisfying  x  —  x b’)  =  o(u;_1)  and  since  the  elements  of  H(x)  are  continuously 
differentiable  around  the  origin,  we  also  have  ||| H(x)  —  H(x) |||  =  o(o;”1)  where 
HI  •  HI  is  an  induced  matrix  norm,  say  the  maximum  column  sum  associated 
with  the  l\  vector  norm.  Since  the  approximate  inversion  controls  v(uJ>  satisfy 

/  \  re  — 2 

v(u>’  =  0(0;™-!)  it  follows  that 

=  o(u;~~),  Vt  >  0, 


and  therefore  lim^oo  ||u(t)  —  u(t)||  =  0,  Vt  >  0. 


□ 


Example  6.2.3  Continuing  Example  6.1.2  and  using  the  estimates  Xi ,  i  =  1,2,3 
from  Example  6.2.1,  the  approximate  inversion  controls  for  the  product  of  expo¬ 
nentials  representation  of  a  two-input,  drift-free,  left-invariant  system  on  SO( 3) 
can  be  written  as 

u  =  H(x)T,  -J,(T(x)) 

with 


Xi 


x\(t)  +  2 u)  2 


sin(o;t) 
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X2  =  —  arcsin(sin(x2(£))  +  w  2  a  (t)  cos  (cut)) 
£3  =  t/3(t)  —  2 o>_2  sin(x2(£))  sin(atf). 


Approximate  Inverse  of 
Original  System 


Figure  6.2:  Approximate  inversion  for  nilpotentizable  systems 


6.3  Feedback  Stabilization  of  Nilpotentizable  Sys¬ 
tems 

According  to  Brockett’s  necessary  condition  (Brockett,  1983)  the  origin  of  a 
regular,  drift-free  systems  of  the  type 

x  =  f^x)^  +  . . .  +  fm(x)um  =  F(x)u,  x  e  Rn  (6.8) 

with  m  <  n  cannot  be  asymptotically  stabilized  with  a  smooth,  time-invariant 
feedback  law,  since  there  does  not  exist  a  neighborhood  Q  of  the  origin  such 
that  the  mapping  7  :  O  x  Rm  — >  Rn ;  (x,  u )  1— >  Rn  is  onto  an  open  set  containing 
the  origin.  Coron  (Coron,  1992)  has  shown,  though,  that  there  exists  a  smooth, 
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time-varying  feedback  globally  asymptotically  stabilizing  the  origin  of  (6.8)  as 
long  as  (6.8)  is  controllable,  although  no  explicit  construction  procedure  is  given 
there. 

Drawing  on  the  concept  of  approximate  inversion  one  can  make  a  simple 
heuristic  argument  for  why  time-varying  controls  achieve  asymptotic  stabiliza¬ 
tion.  The  system  (6.8)  together  with  an  approximate  tracking  control  yields  an 
approximate  identity  operator  in  path  space  which  can  be  robustly  stabilized  by 
a  negative  feedback  and  an  integrator  (see  Figure  6.3)  given  that  the  frequency 
parameter  in  the  approximate  inversion  control  law  is  chosen  sufficiently  large. 
The  feedback  law  thus  can  be  conceptually  decomposed  into  a  steering  compo¬ 
nent  requiring  the  periodic  oscillations  to  excite  higher  order  Lie  brackets  and  a 
robust  stabilization  component.  Although  most  time- varying  feedback  laws  ba¬ 
sically  follow  this  concept  technical  difficulties  obstruct  a  stability  proof  based 
directly  on  this  idea. 

Feedback  Controller 


Figure  6.3:  Decomposition  of  time-varying  stabilizing  controller  into  steering 
and  robust  stabilization  component 


By  restricting  the  attention  to  chained  form  systems  or  a  class  of  systems 
having  similar  properties  the  construction  of  smooth  explicit  control  laws  for 
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asymptotic  stabilization  was  achieved  (Pomet,  1992;  Teel  et  al.,  1992).  These 
smooth  control  laws  suffered  from  slow  convergence  rates  and  it  was  pointed  out 
(M’Closkey  &  Murray,  1995)  that  achieving  exponential  convergence  actually 
requires  feedback  which  is  non-smooth  at  the  origin. 

In  (Struemper  &  Krishnaprasad,  1997)  we  showed  that  a  non-smooth  feed¬ 
back  based  on  the  approximate  inversion  achieves  global  exponential  convergence 
for  the  nonholonomic  integrator  given  the  frequency  parameter  of  the  control  is 
sufficiently  large.  Since  the  nonholonomic  integrator  can  be  viewed  as  a  nilpotent 
approximation  of  the  single  exponential  representation  of  non-nilpotent  control¬ 
lable  systems  on  three-dimensional  matrix  groups  it  could  also  be  shown  that  the 
same  control  law  locally  stabilizes  this  class  of  systems.  But  this  control  has  the 
drawback  that  the  subset  of  the  state  space  where  the  feedback  is  non-Lipschitz 
can  be  reached  in  finite  time  which  causes  loss  of  uniqueness  of  trajectories  and 
numerical  difficulties  for  the  simulation  of  the  corresponding  trajectories. 

Based  on  techniques  in  (Sussmann  &  Liu,  1991;  Morin  et  al,  1996)  presents  a 
method  to  construct  exponentially  stabilizing  controls  for  drift-free  homogeneous 
systems.  The  problem  of  non- uniqueness  is  resolved  there  by  making  use  of 
homogeneous  feedback  which  is  non-smooth  only  at  the  origin.  We  will  use 
this  method  to  construct  a  control  law  for  a  three-dimensional  chained  form 
system  and  show  how  the  applicability  of  this  control  law  can  be  extended  to 
non-nilpotent  systems  by  using  feedback  nilpotentization.  To  do  so  let  us  recall 
some  basic  notion  concerning  homogeneous  vector  fields  (for  details  see  (Hermes, 
1991;  M’Closkey  &  Murray,  1995)). 

Let  x  =  (xi, . . .  ,xn)  be  local  coordinates  for  Rn.  A  dilation  Srx  :  Rn  x 
R+  — »  Rn  is  a  map  parameterized  by  a  weight  vector  r  =  (r i, . . . ,  rn)  of  rationals 
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A  G  R,  A  >  0. 


satisfying  r\  =  1  <  r2  <  •  •  •  <  rn  such  that 

5rxx  =  (\r'x1,...,\r™xn), 

A  continuous  function  /  :  1  x  R"  G  1  is  said  to  be  homogeneous  of  degree  a 
with  respect  to  the  dilation  Sx  if 

f(t,S\X )  =  A  af(t,x). 

We  call  a  continuous  vector  held  X  =  Y^i= i  <h(£,  ^)^|-  on  ®  x  Rn  homogeneous 
of  degree  m  with  respect  to  the  dilation  Sx  if  a%  is  homogeneous  of  degree  r*  —  m 
with  respect  to  to  Sx  for  i  =  1,  2, . . . ,  n.  A  so-called  homogeneous  norm  is  a 
continuous  map  p  :  Mn  — *  R  satisfying  p{x)  >  0,  p(x)  =  0  x  =  0  and 
p(Srxx)  =  A p(x),  VA  >  0.  Thus  the  three-dimensional  chained  form  system 


x  = 


(  i  \ 
0 


Ml 


«2  =  fl{x)u!  +  h{x)u2 


(6.9) 


W  VV 

has  degree  one  vector  fields  with  respect  to  the  dilation  6X  with  r  =  (1,1,2), 
while  a  homogeneous  norm  for  this  case  can  be  chosen  to  be  p(x)  =  (xf  +  x\  + 
Xg)2.  To  make  optimal  use  of  this  setting  in  stability  theory  the  usual  definition 
of  exponential  stability  is  generalized  to  account  for  the  modified  measure  of 
distance  induced  by  the  norm  p(-)  homogeneous  with  respect  to  Sx. 


Definition  6.3.1  The  equilibrium  point  x  =  0  is  locally  exponentially  stable 
with  respect  to  the  homogeneous  norm  p(-)  if  there  exist  two  constants  a,/3  >  0 
and  a  neighborhood  U  of  the  origin  such  that 


p((f(t,t0,x0))  =  f3p(x0)  e  a[t  to\  \/t>0,Vx0eU.  (6.10) 
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This  notion  of  stability  is  often  called  p-  exponential  stability ,  bnt  we  will 
also  refer  to  it  simply  by  exponential  stability  in  the  context  of  systems  with 
homogeneous  vector  fields.  An  appealing  consequence  of  homogeneity  is  the  fact 
that  for  homogeneous  degree  zero  vector  fields  local  asymptotic  stability  of  the 
origin  is  equivalent  to  global  exponential  stability. 

Using  the  methods  described  in  (Morin  et  al,  1996)  a  exponentially  stabiliz¬ 
ing  feedback  law  can  be  given  as 


with 


Ui(t,x)  =  — Xi  +  hi(x)  +  p u> 2  cos(od) 

u2(t,x)  =  —  X2  +  h2(x)  —  2 p~4  ai(x)  sin(nd) 


(6.11) 


hi(x)  =  p  4  a3(x)  (2x\  +  x2x3) 
h2(x)  =  2  (p~4  x\  ai(x)  —  Xi) 

Oil(x)  =  —x3  +  XiX2. 

Note  that  this  control  can  be  interpreted  as  originating  from  the  open-loop  con¬ 
trol  law  4.11  by  replacing  x^  i  =  1,  2,3  by  —  Xi,  introducing  the  norm  p(-),  and 
determining  the  functions  ht ( • ) ,  i  =  1,2  such  that 

[2p/i(x),  p_1  aii(x)  f2(x)]  =  hi(x)/i(x)  +h2(x)f2(x)  +  [fi(x),  f2(x)]. 

Asymptotic  stability  of  control  laws  of  this  kind  for  uj  sufficiently  large  is 
shown  in  (Morin  et  al. ,  1996)  by  choosing  a  time- varying  Lyapunov  function 
and  decomposing  the  differentiable  operator  corresponding  to  the  closed  loop 
vector  held  suitably  with  a  process  similar  to  integration  by  parts.  Since  the 
feedback  law  u(t,  x)  is  homogeneous  of  degree  one  the  closed  loop  vector  held  is 
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homogeneous  of  degree  zero  with  respect  to  Srx  and  global  exponential  stability 
for  (6.9)  follows. 

Since  the  construction  procedure  in  (Morin  et  ai,  1996)  is  restricted  to  sys¬ 
tems  with  homogeneous  vector  fields  it  cannot  be  directly  applied  to  local  rep¬ 
resentation  of  invariant  systems  on  non-nilpotent  matrix  groups. 

A  first  strategy  to  extend  these  stabilizing  feedbacks  to  nonholonomic  systems 
on  non-nilpotent  matrix  groups  is  to  compute  homogeneous  approximations  for 
their  local  representations.  This  can  be  done  conveniently  by  reading  of  the 
leading  terms  of  the  single  exponential  representation  (2.12)  in  the  coordinates 
relative  to  a  basis  {A\, . . . ,  Am}  which  is  adapted  to  the  growth  vector  of  the 
system.  Applying  the  construction  procedure  of  (Morin  et  ai,  1996)  to  the 
resulting  homogeneous  approximation  yields  feedback  laws  locally  exponentially 
stabilizing  the  original  systems. 

On  the  other  hand  we  can  achieve  exponentially  stabilizing  feedback  laws 
with  a  reasonably  large  guaranteed  domain  of  stability  by  converting  the  original 
system  with  a  nilpotentizing  feedback  into  homogeneous  form  and  applying  the 
construction  procedure  to  the  transformed  system.  Thus  the  resulting  region  of 
stability  is  only  limited  by  the  region  for  which  the  nilpotentizing  transformation 
is  defined.  The  relationship  of  nilpotent  approximation  and  (exact)  feedback 
nilpotentization  to  the  point  stabilization  problem  is  therefore  comparable  to 
the  situation  encountered  when  using  exact  feedback  linearization  as  opposed 
to  ordinary  (Jacobian)  linearization  in  the  construction  of  stabilizing  feedback 
laws. 

Example  6.3.2  For  each  of  the  systems  on  SE( 2),  SL( 2),  and  SO(3)  for  which 
we  derived  in  Chapter  5  the  transformations  H(x)  and  T(x )  converting  them 
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to  the  form  (6.8)  we  can  thus  derive  a  exponentially  stabilizing  feedback  law. 
Letting  ucfs(t,x )  =  x),  U2(t,  x))T  with  tq,  i  —  1,2  taken  from  (6.11)  we 

thus  obtain  in  the  case  of  SO (3)  the  exponentially  stabilizing  control  law 


USO{  3) 


H(x)ucfs(t,T(x )) 

l 


H(x) 


V 


COS  X2  COS  £3 

—  cos  X2  sin  X3 


\ 

—  sec  X2  sin  X3 

—  sec  X2  cos  X3  , 


(6.12) 


given  u  is  chosen  sufficiently  large.  Figures  6.4  and  6.5  show  simulations  of 
trajectories  resulting  from  this  control  law  using  frequencies  u  —  1  and  u  =  10, 
respectively.  Simulations  with  different  initial  conditions  suggest  that  u  =  1  is 
indeed  already  sufficiently  large  for  exponential  stabilization. 
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Figure  6.4:  Stabilization  of  local  representation  of  system  on  SO( 3)  using  feed¬ 
back  nilpotentization  and  homogeneous  feedback  (u  =  1,  xi(-)  —  ,  —  ■—  , 

®3(0  -  -) 
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Figure  6.5:  Stabilization  of  local  representation  of  system  on  SO( 3)  using  feed¬ 
back  nilpotentization  and  homogeneous  feedback  (u  =  10,  Xi(-)  —  ,  —  •—  , 

®3(0  -  -) 
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Chapter  7 


Conclusion 


In  this  dissertation  we  investigated  the  problem  of  motion  control  for  nonholo- 
nomic  systems  on  finite-dimensional  matrix  Lie  groups.  This  work  contributes 
to  the  larger  project  in  nonlinear  control  theory  of  deriving  control  laws  method¬ 
ically  from  the  Lie  algebra  of  vector  fields  associated  with  a  given  system  and 
characterizing  classes  of  systems  for  which  this  is  possible.  Systems  on  nilpotent 
matrix  Lie  groups  and  their  local  representations  proved  to  be  an  especially  suit¬ 
able  setting  to  address  motion  control  problems.  Comparable  to  the  technique  of 
feedback  linearization  the  approach  taken  here  was  to  interpret  nilpotent  system 
as  a  canonical  form  for  certain  nonlinear  systems.  Characterizing  the  systems 
reducible  to  this  form  and  identifying  the  corresponding  transformations  we  ex¬ 
tended  the  relatively  simple  control  laws  for  nilpotent  system  to  a  wider  class  of 
non-nilpotent  systems. 

In  Chapter  2  we  reviewed  basic  notions  concerning  Lie  groups,  Lie  algebras 
and  invariant  vector  fields  defined  on  Lie  groups.  We  characterized  systems 
on  matrix  Lie  groups  and  studied  their  local  representations.  To  illustrate  the 
intimate  relationship  between  Lie  groups  and  mechanical  systems  of  practical 
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interest  we  presented  and  analyzed  several  examples  of  the  kinematics  of  me¬ 
chanical  systems. 

Chapter  3  defined  basic  problems  of  motion  control  and  introduced  the  inter¬ 
pretation  of  an  open-loop  tracking  control  law  as  an  approximate  inverse  system 
of  a  given  system.  Using  the  example  of  Brockett’s  nonholonomic  integrator 
we  illustrated  the  basic  principles  of  motion  generation  via  high-frequency  con¬ 
trols  and  presented  different  forms  of  approximate  inversion  control  laws.  With 
the  goal  of  characterizing  the  inherent  trade-off  between  tracking  accuracy  and 
control  effort  we  studied  the  optimal  control  problem  for  the  nonholonomic  in¬ 
tegrator  with  a  control  objective  which  also  included  trajectory  error  terms. 

In  Chapter  4  we  started  out  by  relating  the  nonholonomic  integrator  and 
the  familiar  chained  and  power  form  systems  to  invariant  systems  on  the  same 
nilpotent  matrix  Lie  group.  The  main  result  of  this  chapter  was  an  open-loop 
approximate  tracking  control  law  for  chained  form  systems  which  could  be  cast 
in  a  relatively  simple  form  due  to  the  convenient  Lie  algebra  structure  of  chained 
form  systems. 

In  Chapter  5  we  introduced  the  technique  of  nilpotentization  and  studied  the 
question  to  which  systems  on  matrix  Lie  groups  this  technique  could  be  applied. 
In  the  case  of  systems  on  three-dimensional  matrix  Lie  groups  we  succeeded  in 
deriving  a  systematic  procedure  to  construct  the  nilpotentizing  transformations 
directly  from  the  Lie  algebra  structure  of  the  underlying  matrix  group.  This  is 
remarkable  since  the  problem  of  finding  such  transformations  generally  requires 
the  solution  of  a  partial  differential  equation.  We  also  investigated  the  possibility 
of  transforming  systems  on  higher-dimensional  matrix  Lie  groups  into  chained 
or  other  nilpotent  forms. 
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Chapter  6  addressed  the  problem  of  motion  control  for  nilpotentizable  sys¬ 
tems.  We  started  out  by  extending  the  approximate  tracking  control  law  derived 
in  Chapter  4  to  non-nilpotent  systems.  We  then  succeeded  in  converting  these 
control  laws,  which  involved  a  state  feedback  due  to  the  nilpotentizing  trans¬ 
formation,  back  into  open-loop  form.  Again  using  feedback  nilpotentization,  we 
constructed  exponentially  stabilizing  control  laws  for  non-nilpotent  systems  by 
extending  the  region  of  attraction  of  otherwise  only  locally  valid  control  laws. 

As  an  extension  of  this  work  we  will  investigate  the  application  of  the  meth¬ 
ods  derived  above  to  systems  with  drift.  Here,  one  needs  to  consider  the  case  of 
invariant  drift  vector  fields  as  encountered  in  coherent  control  of  quantum  dy¬ 
namics  (Dahleh  et  al .,  1996)  as  well  as  the  case  of  the  full  dynamic  formulation  of 
a  mechanical  system  on  the  tangent  or  cotangent  bundle  of  the  group  manifold. 

We  have  seen  in  Chapter  5  that  for  higher- dimensional  nonholonomic  sys¬ 
tems  only  systems  modeling  a  physical  phenomenon  with  an  inherent  chained 
structure  can  actually  be  transformed  into  chained  form.  However,  there  exist 
nilpotent  model  systems  which  do  exhibit  the  same  growth  vectors  as,  for  in¬ 
stance,  invariant  systems  on  SE( 3).  The  question  whether  and  how  such  systems 
which  violate  the  necessary  conditions  for  transformation  into  chained  form  can 
be  brought  into  other  nilpotent  forms  needs  further  investigation. 

Finally,  considering  the  control  cost  of  moving  in  the  direction  of  higher- 
order  Lie  brackets  it  is  desirable  from  a  practical  point  of  view  to  integrate  the 
trajectory  planner  with  the  approximate  tracking  control  law.  On  the  one  hand 
the  carrier  frequencies  of  the  control  law  should  be  adapted  to  the  accuracy 
required  in  a  certain  phase  of  a  tracking  task,  while  the  trajectory  planner  itself 
should  construct  the  desired  paths  based  on  the  notion  that  shorter  paths  might 
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be  inefficient  depending  on  the  degree  to  which  they  violate  the  nonholonomic 
constraints. 
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